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Robotic  manipulators  provide  general,  programable  mo- 
tion paths  and  force  functions  to  carry  out  highly  dextrous 
and  flexible  processes.  These  systems  are  characterized  by 
several  degrees  of  freedom  of  controllable  motion.  As  a 
consequence,  the  resulting  mechanical  structure  contains  a 
very  large  number  of  design  values  including  geometric, 
mass,  stiffness,  strength  and  actuator  parameters.  The 
mathematical  relations  between  the  parameters  and  the 
manipulator's  force  and  motion  states  are  extraordinarily 
complex,  nonlinear,  and  highly  coupled.  Therefore,  the 
design  of  manipulators  is  an  expensive,  time-consuming,  and 
challenging  task.  Presently,  the  designers  are  lacking 
guidelines  and  well  established  design  criteria. 

This  study  brings  together  two  fields:  optimization 

theory  and  robotics.  The  goal  is  to  develop  analysis, 
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design  criteria  and  computational  tools  for  optimizing  the 
distribution  of  actuator  parameters  which  satisfy  load  and 
precision  requirements  and  increase  the  system's  funda- 
mental natural  frequency  for  faster  operations. 

A rigid-link  manipulator  model  is  employed  in  this 
study.  Computer  generated  plots  are  used  to  display 
extensive  analysis  information  in  a compact,  understandable 
form.  These  plots  show  how  system  parameters  vary  as  a 
function  of  hand  position.  Computer-aided  procedures  for 
systems  become  an  imperative  in  order  to  establish  the 
dynamic  design  formulation,  select  rational  design  specifi- 
cations, and  evaluate  the  system's  operating  characteris- 
tics both  locally  and  globally. 

In  order  to  develop  a first  level  of  computational  and 
design  methodology,  local  properties,  i.e.,  properties  at  a 
specified  configuration  of  the  device,  are  considered 
first.  A more  complete  methodology  would  result  by  con- 
sidering a range  of  configurations  in  the  workspace.  This 
leads  to  the  application  of  general  nonlinear  optimization 
techniques  to  develop  design  tools  for  manipulators.  The 
design  techniques  developed  here  can  greatly  reduce  the 
design  cycle  time  for  accurate,  reliable  manipulators,  and 
also  be  used  to  improve  or  redesign  existing  manipulators 

to  produce  better  dynamic  performance.  A detailed  analysis 

3 

for  the  industrial  robot  T -776  is  presented. 
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CHAPTER  1 


INTRODUCTION 

1 . 1 Subject  Background  and  Dissertation  Goals 

The  need  to  establish  design  criteria  and  design 
processes  for  robotic  manipulators  has  been  recognized  as  a 
major  subject  at  a Robotics  Workshop  [ 1 ] ^ held  in  1978  at 
University  of  Florida  and  well  documented  [2—5] . This  need 
is  especially  evident  for  next  generation  robotic  systems 
which  will  be  used  for  high-speed  and  precision  operations, 
and  will  have  more  general  geometric  structures.  Almost 
all  manipulators  in  use  today  have  very  simple  geometric 
structures,  which  can  be  analyzed  by  simple  computational 
procedures  but  which  do  not  provide  the  functional  capacity 
of  more  general  devices.  The  design  of  a general  robotic 
manipulator  is  an  expensive,  time-consuming  and  challenging 
task,  because  there  is  a large  number  of  system  design 
parameters.  The  magnitude  of  this  task  can  be  illustrated 
by  noting  that  a general  six  degree  of  freedom  serial  ma- 
nipulator can  have  as  many  as  18  geometric  parameters,  60 

^The  numbers  in  brackets  refer  to  references  at  the 
end  of  the  document. 
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mass  parameters  and  42  stiffness  parameters,  along  with  12 

or  more  actuator  parameters.  The  design  and  development  of 

such  a generic  structure  can  cost  millions  of  dollars.  For 

3 

example,  the  Cincinnati  Milacron  T arm  took  6 years  to 
develop  and  an  outlay  of  $6  million  [4] . The  NASA  space 
shuttle  manipulator  is  said  to  have  cost  about  $100  million 
[6].  As  requirements  for  precision  operation,  cyclic  speed 
of  operation,  external  loads  and  complexity  of  geometry 
increase,  the  ability  to  meet  complex  design  objectives 
becomes  more  critical.  The  manipulator  is  proving  to  be 
one  of  the  most  difficult  of  our  present  day  systems  to 
design.  One  of  the  important  means  of  breaking  this  tech- 
nological barrier  is  the  creation  of  a body  of  mathematical 
tools  which  is  capable  of  making  the  design  of  new,  more 
versatile  systems  feasible  and  the  precision  operation  of 
these  systems  a reality. 

The  objective  of  this  report  is  to  develop  analysis 
procedures,  design  criteria  and  computational  design  tools 
for  optimizing  the  distribution  of  actuator  strength  and 
stiffness  parameters  and  increasing  the  system's  funda- 
mental natural  frequency  in  a general  robotic  manipulator. 
The  results  should  lead  to  improved  system  performance, 
economy  and  reliability,  and  should  reduce  the  design  cycle 
time  which  today  is  6 to  8 years. 

To  analyze  and  design  a manipulator  requires  a repre- 
sentative dynamic  model  of  the  system.  A report  [7] 
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establishes  the  rigid-link  manipulator  model  and  develops 
analysis  methods,  based  on  classical  optimization,  for 
evaluating  the  maximum  accelerations,  velocities  and  static 
load  capacities  for  a given  manipulator  configuration.  The 
model  formulation  explicitly  shows  how  system  strength  and 
speed  characteristics  vary  with  the  configuration  of  the 
system.  Since  this  position  dependence  is  nonlinear,  gen- 
eral nonlinear  optimization  algorithms  are  required  to 
isolate  the  "worst-case"  hand  positions.  This  work  sug- 
gests some  applications  of  nonlinear  programming  optimi- 
zation in  the  analysis  and  design  of  manipulators,  using 
position  dependent  kinematic  and  modeling  coefficients  to 
explicitly  show  the  role  of  the  significant  parameters. 
Specific  examples  are  employed  to  expose  and  demonstrate 
the  procedures.  Similar  theoretical  and  computational 
tools  are  applicable  to  other  related  tasks,  such  as  con 
trol  of  redundant  manipulators  [8-10]  or  evaluation  of  a 
device's  reachable  workspace  [11]. 

1 . 2 Problems  and  Promise  of  Manipulators 

Robotic  manipulators  represent  a technology  which  has 
rapidly  become  an  important  tool  for  increasing  produc- 
tivity and  quality  in  industry.  Together  with  the  digital 
computer  and  computer-aided  manufacturing  equipment  they 
have  caused  a shift  in  the  history  of  manufacturing  similar 
to  that  which  occurred  when  steam  engines  and  electric 
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motors  were  substituted  for  human  labor.  In  this  new  shift 
the  main  event  is  that  the  information  flow  is  increasingly 
being  automated. 

The  industrial  robot  industry  emerged  in  the  late 
1960s  and  thus  can  be  considered  in  its  infancy  (compare, 
for  instance,  with  the  machine  tool  industry).  The 
following  facts  constitute  a basis  for  the  importance  of 
this  new  industry: 

1.  it  is  an  industry  with  a very  high  growth 
potential; 

2.  it  has  become  a symbol  for  flexible  factory 
automation  in  general  and  thus  has  large  indirect 
effects  on  the  wide  diffusion  of  CAD/CAM. 

Industrial  robots  are  a key  component  of  flexible 
manufacturing  technologies  because  their  reprogramability 
allows  them  to  be  quickly  adapted  to  changes  in  the 
production  process.  There  are  many  major  benefits  to  be 
gained  from  using  robots  in  manufacturing: 

1.  increased  productivity; 

2.  increased  product  flexibility; 

3.  reduced  labor  cost; 

4.  elimination  of  dangerous  and  undesirable  jobs; 

5.  improved  product  quality. 
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The  introduction  of  robots  led  to  high  expectations 
for  their  use.  However,  during  the  past  twenty  years, 
robot  applications  have  been  limited  primarily  to  the  areas 
which  are  simple  and  most  easily  achieved  industrial 
functions  such  as  the  following: 

1 . spot  welding ; 

2.  material  handling; 

3.  machine  loading; 

4 . inspection; 

5.  simple  assembly. 

Because  the  limitations  of  manipulator  application,  sev- 
eral problem  areas  have  been  identified  in  order  to  enhance 
robotics  technology  and  applications.  At  the  top  of  the 
list  of  problem  areas  is  the  issue  of  precision.  Manufac- 
turer's of  robots  rarely  publish  information  regarding 
accuracy,  preferring  to  describe  repeatability  instead. 
Repeatability  is  the  ability  of  a manipulator  to  position 
the  end  effector  at  a taught  position  in  space  within  a 
radius  of  the  smallest  sphere  that  can  include  all  return 
points.  Accuracy  is  the  difference  between  the  specified 
point  and  the  center  of  the  sphere.  Figure  1.1  shows  the 
concepts  of  accuracy  and  repeatability  in  the  two  dimen- 


sional case  [12]. 
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A - Accuracy 
R - Repeatability 


Figure  1.1  Accuracy  and  repeatability 
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The  absolute  accuracy  of  most  industrial  robots  is 
known  to  be  not  better  than  + 0.05  inches.  Assembly  and 
light  machining  operations  require  a positional  accuracy  of 
less  than  0.005  inch;  otherwise,  off-line  programming 
cannot  be  used.  The  more  difficult  condition  is  to  main- 
tain accuracy  while  the  manipulator  experiences  large  load 
variations.  Industrial  robots  are  commonly  available  with 
repeatability  of  +0.008  inches.  The  same  improvements  are 
needed  in  repeatability  as  in  positional  accuracy. 

A second  problem  area  is  the  speed  at  which  robots 
move  through  a operating  cycle.  Typical  robots  of  today  do 
not  work  any  faster  than  human  workers.  High-speed  opera- 
tions for  robots  offer  a serious  challenge  to  the  servo 
systems  and  control  systems  which  must  be. fast  enough  to 
accommodate  the  rapid  changes  in  inertial  characteristics 
of  the  robot  as  velocities  and  accelerations  change  during 
operations . 

Third  identified  problem  area  is  that  current  indus- 
trial robots  are  too  large,  too  massive,  and  lacking  in 
versatility.  They  can  lift  weights  equal  to  only  about  10% 
of  their  own  weight.  The  prospects  in  this  area  for 
improved  mass  distribution  in  the  system  and  the 
utilization  of  lightweight  materials  are  very  promising. 

Another  area  is  the  need  of  great  geometric  dexter- 
ity. In  material  handling  operations,  assembly  and  nuclear 
maintenances,  currently  available  industrial  robots  are  not 


8 


adequately  flexible  to  enable  them  to  perform  a variety  of 
tasks.  Most  robots  are  constructed  with  six  or  less  de- 
grees of  freedom.  One  of  the  best  ways  to  increase  dexter- 
ity is  to  add  additional  degrees  of  freedom  to  an  arm. 

These  redundant  degrees  of  freedom  make  obstacle  avoidance 
much  more  likely.  Unfortunately,  these  redundant  degrees 
of  freedom  make  the  control  of  such  a manipulator  very 
dif  f icult . 

The  final  important  problem  area  is  in  the  control 
systems.  Several  subareas  of  improvements  are  required  in 
robot  control  systems.  Controllers  need  to  be  much  more 
sophisticated  in  their  ability  to  interact  between  manipu- 
lators and  sensors  in  real  time,  because  the  flow  of  data 
from  sensors  in  the  system  increases  in  order  to  increase 
manipulator’s  operational  capacity  and  precision,  and  the 
complexity  of  this  mathematical  interface  increases 
exponentially . 

There  are  still  many  other  problem  areas,  such  as 
interfaces,  sensors,  programming  languages,  etc.,  which 
need  improvement  before  a truly  major  impact  of  using 
robots  for  manufacturing  will  be  felt  on  the  economy. 

1 . 3 Survey  of  Pertinent  Literature 

The  level  of  interest  in  the  application  of  optimiza- 
tion methods  to  mechanical  design  seems  has  increased  dra- 
matically during  the  past  two  decades.  The  main  reason  for 
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this  is  that  the  development  of  the  digital  computer  has 
irrevocably  changed  the  viewpoint  and  increased  the  compu- 
tational ability  of  the  engineering  analyst.  The  ultimate 
goals  are  means  to  achieve  mechanical  designs  which  are 
globally  optimum  relative  to  all  pertinent  criteria. 

A review  of  some  historical  developments  and  relevant 
literature  in  the  areas  of  optimization  theory  and  manipu- 
lator dynamics  is  given  in  the  following  two  sections. 

1.3.1  Historical  Development  of  Optimization 

Some  early  attempts  to  optimize  were  those  of  da  Vinci 
(1452-1519)  and  Newton  (1642-1727),  who  were  both  involved 
in  specific  mechanism  design  problems  [13,14],  and  made 
modifications  of  previous  designs  to  enhance  their  per- 
formance. Galileo  (1564-1642)  developed  a rational  opti- 
mization scheme  [15]  for  selecting  the  form  of  a bent  beam 
for  uniform  strength. 

Optimization  theory  advanced  significantly  with  the 
development  of  the  differential  calculus  which  introduced 
an  elegant  way  for  the  evaluation  of  maxima  and  minima  of 
differentiable  functions.  The  foundations  of  the  calculus 
of  variations  were  laid  by  Bernouli  [16] , Euler  [17]  and 
Lagrange  [17].  The  method  of  optimization  for  constrained 
problems,  which  involves  the  addition  of  unknown  multi- 
pliers became  known  by  the  name  of  its  inventor,  Lagrange. 
Cauchy  ( 1 7 8 9- 1 8 5 7 ) [ 1 9 ] proposed  the  steepest  descent 
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algorithm  to  solve  unconstrained  minimization  problems  in 
1847.  In  spite  of  these  early  contributions,  very  little 
progress  was  made  until  the  middle  of  the  twentieth 
century,  when  high-speed  digital  computers  made  the 
implementation  of  the  optimization  procedures  possible  and 
stimulated  further  research  on  new  methods.  Spectacular 
advances  followed,  producing  massive  literature  on 
optimization  techniques. 

Since  the  simplex  method  of  Dantzig  [20]  in  1949  for 
linear  programming  problems  and  the  work  of  Kuhn  and  Tucker 
[21]  in  1951  on  the  necessary  and  sufficient  conditions  for 
the  optimal  solution  of  nonlinear  programming  problems  laid 
the  foundations  for  later  development  of  the  methods  of 
constrained  optimization.  Bellman  [22]  developed  the  prin- 
ciple of  optimality  in  1957  for  dynamic  programming  which 
is  a mathematical  technique  well  suited  for  the  optimi- 
zation of  multistage  decision  problems.  Significant  devel- 
opments have  taken  place  in  the  area  of  gradient  techniques 
with  the  introduction  of  the  Variable  Metric  method  sug- 
gested by  Davidon  [23]  and  modified  by  Fletcher  and  Powell 
[24].  This  extremely  successful  method  is  an  enormous 
improvement  over  simple  steepest  descent  algorithms.  The 
contributions  of  Zoutendijk  [25]  and  Rosen  [26,  27]  to 
nonlinear  programming  during  the  early  part  of  the  1960s 
have  also  been  very  significant.  Although  no  single  tech- 
nique has  been  found  to  be  universally  applicable  for 
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nonlinear  programming  problems,  the  penalty  function 
algorithms  developed  by  Fiacco  and  McCormick  [28]  made  many 
difficult  problems  solvable  by  using  the  well-known  tech- 
niques of  unconstrained  optimization.  Geometric  pro- 
gramming was  developed  in  the  1960s  by  Duffin,  Zener  and 
Peterson  [29].  Gomory  [30]  did  pioneering  work  in  integer 
programming.  Some  papers  that  review  the  state  of  the  art 
of  optimization  have  been  written  by  Fletcher  [31],  Dixon 
[32]  and  Powell  [33,34,35] . 

1.3.2  Development  of  Manipulator  Dynamics 

The  need  for  efficient  mathematical  formulations  of 
manipulator  dynamics  has  been  recognized  and  the  develop- 
ment of  these  formulations  has  rapidly  grown  in  the  past 
decade.  The  importance  of  dynamics  of  robotics  manipu- 
lators stems  from  its  use  in  simulation,  analysis,  control 
and  design  for  the  next  generation  robotic  systems  which 
will  be  used  for  high-speed  and  precision  operations. 

In  1965,  Uicker  [36]  formulated  a derivation  of  the 
equations  of  motion  for  spatial  mechanisms  using  4x4 
transformation  matrices  and  the  Lagrange  equations.  These 
results  were  specifically  written  for  open  loop  manipu- 
lators by  Kahn  [37],  but  these  solutions  require  excessive 
computation  and  were  recognized  as  impractical  for  real 
time  control  applications.  Bejczy  [38]  considered  neg- 
lecting the  velocity-related  terras  to  obtain  a simpler 
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approximation  for  actuator  torques,  but  the  results  are 
inaccurate  in  many  cases.  In  a parallel  effort  to  reduce 
computation  time,  Whitney  [39]  and  Raibert  [40]  considered 
the  possibility  of  using  lookup  tables.  A dramatic  cut  in 
the  time  required  for  calculations  may  be  attained.  How- 
ever, the  amount  of  storage  necessary  for  control  of  a 
general  spatial  manipulator  is  extremely  large.  Further- 
more, additional  problems  in  storage  and  access  of 
information  may  occur. 

The  inefficiency  of  the  original  Uicker/Kahn  formula- 
tions, as  well  as  other  reasons,  has  led  researchers  to 
look  for  alternative  formulations  of  manipulator  dynamics. 
In  the  effort  to  make  real  time  dynamic  computation  feasi- 
ble, recursive  algorithms  have  been  developed  using  both 
Newton-Euler  [41,42]  and  Lagrangian  [43]  dynamic  formu- 
lations and  Silver  [44]  has  shown  that  with  a proper  choice 
the  Lagrangian  formulation  is  indeed  equivalent  to  the 
Newton-Euler  formulation.  In  these  methods,  the  velocity 
and  acceleration  of  each  link  are  found  sequentially 
starting  with  the  fixed  base  link.  Then,  beginning  at  the 
free  end  and  moving  back  to  the  fixed  base,  the  force  or 
torque  on  each  successive  joint  is  determined.  These 
recursive  methods  are  computationally  the  fastest  for 
evaluating  the  actuator  and  link  loads  for  a prescribed  arm 
motion  state  with  known  external  loads  and  manipulator 
properties.  However,  their  use  for  design  is  limited  to 
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trial-and-error  analysis,  because  the  geometric  properties 
of  manipulators  are  hidden  in  their  recurrence  relations. 

Recently,  non- r ecur s i ve  formulation  which  keeps  the 
dynamic  terms  and  the  important  design  parameters  explicit 
in  the  equations  of  motion  has  been  developed  by  Thomas  and 
Tesar  [5,7].  The  method  is  especially  well-suited  for 
manipulator  systems  because  expressions  for  the  kinematic 
influence  coefficients,  the  basic  components  of  the  model, 
are  extremely  simple  and  compact  for  serial  manipulators. 
The  influence  coefficients  may  also  provide  a highly  effi- 
cient algorithm  for  evaluating  the  dynamic  model  in  real 
time.  Thus,  the  influence  coefficient  formulation  may  be 
advantageous  for  both  the  control  and  design  of  mechanisms 
and  manipulators.  This  modeling  approach  has  been  extended 
to  modeling  and  analysis  of  hybrid  parallel/ serial  manipu- 
lators by  Sklar  and  Tesar  in  1984  [45].  More  applications 
of  influence  coefficients  for  planar  mechanisms  can  be 
found  in  [46,47,48]. 

1 . 4 Scope  of  the  Study 

This  work  brings  together  two  fields,  namely,  opti- 
mization theory  and  robotics  in  order  to  develop  design 
criteria  and  computational  design  tools  for  robotic  manipu- 
lators. In  Chapter  2 basic  theorems  of  optimization  are 
reviewed  and  some  methods  of  nonlinear  programming  are 


discussed . 
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Chapter  3 of  the  report  covers  the  kinematic  aspects 
of  the  manipulator  problem  and  the  kinematic  influence 
coefficients.  Based  on  the  kinematic  influence  coeffi- 
cients, the  dynamic  model  for  dealing  with  applied  loads, 
inertial  loads,  deflections,  stiffness  matrices,  and 
natural  frequencies  are  introduced. 

Chapter  4 illustrates  the  use  of  the  modeling  formu- 
lation for  the  analysis  of  the  characteristics  of  an 
industrial  robot.  Computer  generated  contour  plots  are 
employed  to  express  the  massive  data  in  a compact  form.  I 
Chapter  5,  some  local  dynamic  criteria  are  established  for 
distribution  of  certain  design  parameters  which  are 
modelled  in  Chapter  3. 

The  localized  techniques  in  Chapter  5 are  extended  to 
develop  global  dynamic  design  criteria  for  general  robotic 
manipulators.  These  design  procedures  make  it  possible  to 
satisfy  load  and  precision  requirements  and  provide  faster 
operation  by  increasing  the  frequencies  of  the  fundamental 
vibrational  modes.  Chapter  7 offers  conclusions  and 
suggestions  for  future  research  work. 


CHAPTER  2 


OPTIMIZATION  THEORY 
2 . 1 Introduction  to  Optimization 

Man's  longing  for  perfection  finds  expression  in  the 
theory  of  optimization.  It  studies  how  to  describe  and 
attain  what  is  best,  once  one  knows  how  to  measure  and 
alter  what  is  good  or  bad.  Normally,  one  wishes  the  most, 
or  maximum,  good  and  the  least,  or  minimum,  bad.  Optimum 
has  become  a technical  term  connoting  quantitative  measure- 
ment and  mathematical  analysis,  whereas  "best"  remains  a 
less  precise  word  more  suitable  for  everyday  affairs.  The 
technical  verb  optimize,  a stronger  word  than  "improve," 
means  to  achieve  the  optimum,  and  optimization  refers  to 
the  act  of  optimizing.  Thus  optimization  theory  encom- 
passes the  quantitative  study  of  optima  and  methods  for 
finding  them. 

In  order  to  have  a solvable  optimization  problem,  the 
desired  benefit  or  the  required  effort  must  be  expressible 
as  a function  of  a set  of  variables  over  which  the  designer 
has  control.  These  variables  are  called  the  design  varia- 
bles. Limits  on  the  values  of  design  variables  may  result 
from  such  things  as  the  limitations  on  the  behavior  or 
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performance  of  a system.  These  limiting  factors  are  called 
constraints,  and  they,  too,  must  be  expressible  as  func- 
tions of  the  design  variables. 

It  can  be  seen  from  Figure  2.1  that  the  minimum  value 
of  a function,  f(x),  corresponds  to  the  maximum  value  of 
the  negative  function,  -f(x).  Thus,  without  loss  general- 
ity, optimization  can  be  taken  to  mean  minimization  since 
the  maximum  of  a function  can  be  found  by  seeking  the 
minimum  of  the  negative  of  the  same  function. 

2 . 2 Definition  of  Optimization  Problems 

A common  characteristic  of  all  optimization  problems 
is  the  existence  of  many  feasible  solutions.  The  seeking 
of  the  best  possible  solution  depends  on  a clear  definition 
of  the  interaction  of  all  the  design  variables,  an  explicit 
statement  of  criterion  or  objective,  and  an  effective 
search  procedure  for  locating  the  optimum  in  accordance 
with  the  stated  objective. 

An  optimization  or  a mathematical  programming  problem 
can  be  stated  in  the  following  general  form  [49]. 

Find  X=[X1,  X2 , ...,  Xn]T  which  minimizes  f(X) 

subject  to  the  equality  constraints 

gj(X)  =0,  j=l,  2,  . . . , m (2.1) 

and  the  inequality  constraints 
h.(X)  < 0, 


j=m+l , m+2 , . . . , p 


(2.2) 
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Figure  2.1  Minimum  of  f (X)  is  same  as  the  minimum  of  -f(X) 
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where  X Is  called  design  vector,  and  f(X)  is  called  the 
objective  function.  A necessary  condition  for  existence  of 
a design  problem  is  n>m,  in  order  to  ensure  the  existence 
of  free  parameters.  If  there  are  no  constraints  (p=0),  the 
problem  is  said  to  be  unconstrained.  An  optimization 
problem  is  said  to  be  linear  if  the  objective  function  f(X) 
and  all  the  constraint  functions  are  linear  in  the  n 
variables,  Xx , X2 , ...,  Otherwise,  the  optimization 

problem  is  said  to  be  nonlinear. 

2 . 3 Concept  of  Vector  Norms 

Since  manipulators  and  mechanisms  operate  in  a multi- 
dimensional space,  the  objective  and  constraint  functions 
usually  contain  vector  quantities  to  describe  important 
design  criteria  or  dynamic  phenomena.  It  is  necessary  to 
have  some  means  of  "measuring”  vectors,  in  order  to  say 
that  one  vector  is  "larger"  or  "smaller”  than  another.  The 
definition  of  a norm  gives  a rule  for  associating  a non- 
negative scalar  with  a vector  [50] , then  the  constraint  and 
performance  can  be  written  in  terms  of  scalar  magnitudes 
associated  with  these  vectors.  The  weighted  p-norm  of  a 
vector  u is  defined  as  [6] 

II  H II  p = ( 2 |W  u |p)1/p  (2.3) 

j J 

where  is  the  weighting  factor  for  component  j and  the 

summation  is  performed  over  all  components  of  the  vector. 
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While  W indicates  the  relative  significance  of  component 
j,  the  exponent  p determines  the  importance  of  the  largest 
components  relative  to  the  smaller  ones . The  larger  the 
value  of  p,  the  more  the  vector  norm  depends  on  the  largest 
scaled  component  and  vice  versa. 

The  most  useful  values  of  p are  1,  2 and 


“ II  i 


W.  u . 

J J 


p=l 


(2.4) 


u ||  =(  Z | W . u |2)172,  p = 2 

j 


(2.5) 


£ II  00 


= max ( I W . u . | ) , 

j 2 2 


(2.6) 


In  the  two  dimensional  case',  the  curves  in  Figure  2.2  are 
effectively  contour  curves  along  which  the  norm  is 
constant.  These  particular  norms  are  the  most  popular 
because  they  are  easily  interpreted  and  their  differentia- 
tion, with  respect  to  the  components  u^  , produces  tractable 
results.  In  general,  the  p=2  norm  leads  to  higher-order 
equations  in  the  optimization  solutions.  The  other  two 
norms  often  provide  several  individual  cases  which  each 
mus  t be  solved . 


Non-diagonal  weighting  matrices 
curves  in  the  u-plane. 


[ W ] rotate  these 


20 


Weighting  values  W =1,  W2=1.5 


Norm  value  K=1 


Figure  2.2  Curves  of  constant  magnitude. 
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2 . 4 Optimization  Methods  and  Optimality  Conditions 

The  mathematical  programming  problem  stated  in  Section 
2.2  has  given  rise  to  a great  variety  of  solution  methods. 
In  order  to  select  an  efficient  method  for  solving  a par- 
ticular problem,  it  is  necessary  to  analyze  and  classify 
the  problem. 

2.4.1  Classification  of  Optimization  Problems 

When  faced  with  any  optimization  problem,  it  is  usu- 
ally advantageous  to  determine  the  special  characteristics 
that  allow  the  problem  to  be  solved  more  efficiently. 
Therefore,  we  consider  how  to  classify  optimization  prob- 
lems in  order  to  enhance  the  efficiency  of  the  resulting 
solution  methods. 

Optimization  problems  can  be  classified  in  several 
ways.  For  example,  it  can  be  classified  [49]  on  the  basis 
o f 


1.  the  existence  of  constraints, 

2.  the  nature  of  the  design  variables, 

3.  the  physical  structure  of  the  problem, 

4.  the  nature  of  the  equations  involved. 

Although  no  set  of  classifications  is  ideal  for  every 
circumstance,  the  classification  based  on  the  nature  of 
problem  functions  is  extremely  useful  from  the 
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computational  point  of  view  since  there  are  many  methods 
developed  solely  for  the  efficient  solution  of  a particular 
class  of  problems.  Table  2.1  gives  a typical  classifi- 
cation scheme  based  on  the  nature  of  the  problem  functions. 

It  is  also  highly  desirable  to  organize  the  available 
nonlinear  optimization  approaches  in  order  to  get  a feel 
for  what  is  available,  help  classify  past  and  present 
efforts,  and  perhaps  enhance  decisions  in  future  efforts. 
Figure  2.3  shows  such  a representation. 

In  the  next  three  sections,  three  types  of  methods 
will  be  described:  one-dimensional  optimization,  uncon- 

strained optimization,  and  constrained  optimization.  The 
discussion  has  been  restricted  to  certain  methods  which 
have  proven  useful  in  the  present  report. 

2.4.2  One-Dimensional  Optimization  Methods 

We  begin  by  considering  the  problem  as  follow: 

Find  X which  minimizes  f(X) 
subject  to  Xx  < X < Xu 

where  f(X)  is  a real  function  of  the  real  variable  X,  and 
Xu,  X are  given  bounds  on  X.  We  consider  this  problem 
first  because  it  is  one  of  the  simplest  optimization 
problems  and  because  many  of  the  methods  for  solving  more 
complex  problems  require  the  solution  of  this  problem.  The 
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Figure  2.3  Methods  of  Nonlinear  Optimization 
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following  two  theorems  provide  the  necessary  and  sufficient 
conditions  for  the  relative  or  local  minimum  of  a function 
of  a single  variable  [49]. 

THEOREM  2.1  If  a function  f(X)  is  defined  in  the  interval 

* * 

X. <X<X  and  has  a relative  minimum  at  X=X  where  X, <X  <X  , 
1—  — u 1 u 

and  if  the  derivative  df (X) /dx=f ' (X)  exists  as  a finite 
number  at  X=X* , then  f'(X*)=0. 

THEOREM  2.2  Let  f ' (X* ) = f " ( X* ) = . . . = f ^ n" 1 ^ ( X* ) =0 , but 
f^n^(X  )\0.  Then  f(X*)  is  1).  a minimum  value  of  f(X)  if 
f(n)(x*)>Q  and  n £s  even,  2).  a maximum  value  of  f(X)  if 
f^  '(X  ) <0  and  n is  even,  3).  neither  a maximum  nor  a 
minimum  if  n is  odd. 

Several  numerical  methods,  as  in  Figure  2.3,  are 
available  for  solving  the  one-dimensional  minimization  pro- 
blem. These  can  be  classified  into  two  categories:  elimi- 

nation methods  and  interpolation  methods.  The  elimination 
methods  can  be  used  for  the  minimization  of  discontinuous 
functions.  The  interpolation  methods  involve  polynomial 
approximations  to  the  given  function. 

Golden  Section  Method  [49,  51,  52] 

The  basic  idea  behind  the  methods  of  Golden  Section 
and  Fibonacci  is  to  economize  the  number  of  function  evalu- 
ations, trap  a relative  minimum  in  an  interval  and 
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successively  decrease  the  size  of  the  interval.  The 
process  thus  gives  successively  better  estimates  for  the 
location  of  the  minimum  point.  The  difference  between 
these  two  methods  is  that  in  the  Fibonacci  method  the  total 
number  of  the  experiments  to  be  conducted  has  to  be 
specified  before  beginning  the  calculation,  whereas,  this 
is  not  required  in  the  Golden  Section  method. 

The  Golden  Section  search  technique  can  be  given  in 
the  form  of  a computational  algorithm: 

Step  1.  First  an  upper  bound  q^  must  be  found  for  q. 

It  is  clear  that  0 is  a lower  bound,  q^.  For  a 
chosen  small  step  size  6 in  q,  let  j be  the 
smallest  integer  such  that 
f [X^i)  + £ <S(1.618)k]  > 

k=0  . . j -1  , 

f + E 6(1 .618)*] 

k=  0 

Then  upper  and  lower  bounds  on  the  minimum, 

* 

q , are 

j k j T 2 k 

q = 2 6(1.618),  q = £ 6 (1.618; 

U k=  0 1 k=0 

Step  2.  Compute  f(X^*"^+q  ) and  f (X^ ^ ^+q^) , where 

qa  = qi  + *382  (qu  ~ qi) 
qb  = qi  + *618  (qu  “ ql) 

Step  3.  Compare  f(X^i^+q  ) and  f(X^^+q,  ) and  go 

cL  D 


to  Step  4,  5 or  6. 
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Step  4.  If  f ( 1 ^ +qa ) <f ( 1 ^+qb) , then  q ^ <q  <qb* 

By  the  choice  of  qa  and  qb>  the  new  points 
p -^  = q ^ and  PU  = <1^-  Compute  now  f(X^*^+Pa)  where 
pa  = p1+.382(pu~p1)  • Go  to  Step  7. 


Step  5.  If  f(X(l)+q  ) > f ( X ( 1 ) +q . ) , then  q <q*<q  . 

p^  = qa  and  Pu  = 1u  so  that  pa=qb«  Compute  f(X^"^+ 
Pb)  where  pb=p^+ • 6 18 ( PU"P^ ) • Go  to  Step  7. 

Step  6.  If  f ( X^  ^ ^+qa)  = f ( X ^ i ^+qb  ) , put  q^  = qa  an(* 
qu=qb.  Return  to  Step  2. 

Step  7.  If  | p^  - p^|<e,  where  e is  a predetermined 
accuracy,  put  q =.5(pa+p^)  and  stop. 

Otherwise,  put  q^-p  qa=Pa,  qb=  pb  and  qu  = pu 
and  return  to  Step  3. 


Quadratic  Interpolation  Methods  [49,  51,  52,  53,  54] 

The  interpolation  methods  (see  Figure  2.3)  are  gener- 
ally more  efficient  than  the  F ibonacci- type  methods;  that 
is,  fewer  function  evaluations  are  necessary  for  the 
minimum  to  be  located  to  a specified  accuracy.  But  these 
methods  can  fail  or  be  inefficient  if  the  objective  func- 
tion cannot  be  well  approximated  by  a low-order  polynomial. 

The  obvious  idea  of  using  a low-order  polynomial  for 
curve  fitting  is  that  we  can  replace  a possibly  complex 
function  by  a very  simple  function,  the  minimum  of  which  is 
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known  analytically.  This  will  mean  that  finding  the 
minimum  will  be  a straightforward  procedure.  The  use  of 
quadratic  or  cubic  polynomial  means  that  we  assume  that  the 
approximated  function  is  relatively  smooth  and  possibly 
unimodal  in  the  interval  being  investigated.  In  many 
practical  applications,  a small  enough  interval  assures 
validity  of  this  assumption. 

Box,  Davies,  and  Swann  [53]  recommended  that  the  al- 

* 

gorithm  of  DSC  be  executed  to  bracket  the  minimum,  X , by 
increasing  the  step  size  until  the  minimum  is  overshot  and 
then  a single  quadratic  interpolation  is  performed  to  esti- 
mate  X . Figure  2.4  illustrates  the  procedure  and  the 
algorithm  is  summarized  as 


Step  1.  Evaluate  f(X)  at  the  initial  point  X^). 

If  f(X(0)+  6)<f(X(0)),  go  to  Step  2.  If 
f(X(0)+  <$)>f  (X(0)  ) , let  S~~6  and  go  to  Step 
2.  Where  5 is  a small  step  size. 


Step  2.  Compute  X^+^=X^^  + 6. 

Step  3.  Compute  f(X^+^). 

Step  4.  If  f ( X ^ ;’'+  ■*"  ^ ) <f  ( X ^ ^ ) , double  6 and  return 

to  Step  2 with  i=i+l . If  f ( X ( 1+1 ) ) > f ( X( 1 5 ) , 
denote  x(1+1)  by  X^™),  by  x(m-1), 


etc.,  reduce  5 by  one-half,  and  return  to 
Steps  2 and  3 for  one  more  (only)  calculation. 


29 


f (X) 


Figure  2.4  DSC  unidimensional  minimization 
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Step  5.  Of  the  four  equally  spaced  values  of  X in  the 
set,  X(m+1),  X(m),  X(m_1)  and  X(m_2),  discard 
either  X^m^  or  X^m  2^,  whichever  is  farthest 
from  the  X corresponding  to  the  smallest  value 
of  f(X)  in  the  set.  Let  the  remaining  three 
values  of  X be  denoted  by  X^a\  X^b^,  and 
X^c\  where  X^b^  is  the  center  point  and 
X ( a ) =X( b ) - 5 and  X^c^=X^b^+  6. 


Step  6.  Carry  out  a quadratic  interpolation  to 

•k 

estimate  X 


X*  = X(b)  + 


[f (X(a) ) - f (X(b)) ] 


2 [ f (X 


(a))  - 2f (X(b) ) + f (X(c) ] 


Step  7.  If  | f (X*)-f (X(a) ) | < £ and  | f ( X* ) -f ( X ( b ) ) | < e , 
terminate  the  process.  Otherwise,  reduce  the 
step  size  6 and  find  the  smallest  value  of 
f(X(a)),  f(X(b)),  f(X(c)) , and  f(X*)  and  go 
back  to  Step  1 . 


2.4.3  Unconstrained  Optimization  Techniques 

We  consider  in  this  section  a very  important  class  of 
optimization  problems,  the  class  of  problems  of  minimizing 
a real  valued  function  of  n real  variables  with  no 
constraints.  An  unconstrained  optimization  problem  can  be 
stated  in  the  standard  form  as 
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Find  X such  that  the  objective  function 
f(X)  is  minimum. 

This  problem  can  be  considered  as  a particular  case  of  the 
general  nonlinear  programming  problem.  The  special 
characteristic  of  this  problem  is  that  the  solution  X need 
not  satisfy  any  constraint.  It  is  true  that  rarely  a 
practical  design  problem  would  be  unconstrained;  still  the 
study  of  this  class  of  problems  is  important  because  most 
of  the  unconstrained  optimization  methods  can  be  extended 
to  handle  constrained  problems,  either  by  directly 
considering  the  constraints  or  by  transformation  to  an 
unconstrained  problem. 

The  following  two  theorems  provide  the  necessary  and 

k 

sufficient  conditions  for  X to  be  a relative  minimum  or 
maximum  of  the  unconstrained  optimization  problems  [50]. 

THEOREM  2.3  A function  f (X)  has  a relative  minimum  at 
the  point  X*  if  the  first  partial  derivatives  of  f(X) 

k k 

at  X is  Vf(X  ) = 0 and  the  matrix  of  second  partial 

* 

derivatives  (Hessian  matrix)  of  f(X)  at  X 

V2f(X*)  = [ 32f/3X.  3 X j ] 

2 

is  positive  semi-definite. 


2 

A real  symmetric  matrix  R is  1).  positive  definite  if 
Z^RZ>0  for  all  Z = 0,  2).  positive  semi-definte  if  Z^TRZ^>0  for 
all_Z . 
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■k 

THEOREM  2.4  A sufficient  condition  for  a point  X to 

be  a relative  minimum  point  is  that  the  first  partial 

derivatives  of  f(X)  at  X are  zero  and  the  Hessian 

* 

matrix  evaluated  at  X is  positive  definite. 

Several  methods  are  avilable  for  solving  an  uncon- 
strained minimization  problem.  These  methods  can  be 
classified  into  two  categories:  direct  search  methods  and 

descent  (or  gradient)  methods  (see  Figure  2.3).  The  gradi- 
ent methods  require  either  an  analytical  or  a numerical 
derivative  of  the  objective  function  with  respect  to  the 
design  variables,  whereas  the  direct  search  methods  do  not. 
In  general,  the  direct  search  methods  are  less  efficient 
than  the  descent  methods. 


Variable  Metric  Method  [23,  24,  55] 

Significant  developments  have  taken  place  in  the  area 
of  descent  techniques  with  the  introduction  of  the  Variable 
Metric  method  by  Davidon  [23]  and  modification  of  the  meth- 
od by  Fletcher  and  Powell  [24].  This  method  is  reported  to 
be  one  of  the  most  powerful  known  methods  for  general 
functions  f(X)  [55].  A major  reason  for  the  success  of 
this  method  is  its  capability  to  accumulate  information 
about  the  curvature  of  the  objective  surface  during  the 
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entire  iterative  process,  even  though  only  first  order 
derivatives  of  the  objective  function  need  to  be  computed. 
The  iterative  procedure  of  this  method  can  be  stated  as 
follows : 


Step  1.  Make  an  estimate  X^)  of  the  minimum  point 
and  choose  a symmetric  positive  definite 
matrix  Usually  is  taken  as  the 

identity  matrix  I. 


Step  2.  For  i=0,  1,  2,  ...  compute 

S^(i)  = -H(i)  VfT(X^1^) 

Step  3.  Compute  q = q^li'^  which  minimizes  f(X^^+q  S^  * ^ ) 


Step  4 . Compute 
_r 
X 
H 

where 


(i)  = 

q(  i)  S 

(i) 

(i+D 

= x(i) 

+ 

£(1) 

(i+1) 

= 

+ 

A*1’ 

+ B 


(i) 


z(i) 

= VfT(X(i+1)) 

- VfT(X(i) ) 

A*1’ 

= (r(i>  r^1 

)/r(1)T  /i) 

B^ 

= -(H^) 

y(i)T  H ( i ) T 

)/z<1)T 

5 . If 

« Vf(X(i  + 1))  || 

and  ||X(l+1) 

- x(1) 

H' 


are 


sufficiently  small,  terminate  the  process. 
Otherwise,  return  to  Step  2. 
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The  Variable  Metric  method  has  many  of  the  advantages 
of  the  second  order  gradient  techniques  without  having  some 
of  their  disadvantages.  The  advantages  include  fast 
convergence  near  a minimum  and  finiteness  for  a quadratic 
function.  Due  to  the  symmetry  of  the  method  is  also 

comparable  in  its  computer  storage  requirements.  Comparison 
with  other  quadrat ical ly  convergent  methods  shows  that  the 
Variable  Metric  method  performs  better  for  general  nonquad- 
ratic functions. 

Powell 1 s Method 

Occasionally  in  design  and  analysis  applications,  one 
is  often  faced  with  a problem  in  which  computation  of 
derivatives  of  the  objective  function  is  impossible  or  at 
least  prohibitive  from  a computational  point  of  view.  There 
are  many  techniques  for  solving  this  sort  of  problem  given 
in  [49,  54,  56].  An  efficient  technique  was  developed  by 

Powell  [57]  using  conjugate  directions. 

The  basic  idea  of  the  Powell's  method  can  be  quite 
simply  explained  in  two-dimensional  case  and  is  illustrated 
in  Figure  2.5.  In  descriptive  terms  the  strategy  is  as 
follows: 

1).  Conduct  a minimization  along  a line  in  each  of  the 


coordinate  directions  in  turn. 
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x 


Figure  2.5  Strategy  for  Powell's  method 
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2) .  Make  a pattern  move  which  is  minimization  along 

the  direction  corresponding  to  the  coordinate 
moves  in  item  1. 

3) .  Repeat  item  1 except  that  one  of  the  coordinate 

directions  is  replaced  by  the  direction  of  the 
last  pattern  move. 

4) .  Continue  in  this  fashion  until  the  moves  become 

negligibly  small. 

The  flow  diagram  for  the  Powell's  method  is  given  in 
Figure  2.6.  A computational  algorithm  is  presented  as 
f o 1 lows : 

Step  1.  Make  an  estimate  of  the  minimum  point  X ^ ) 

of  f(X).  Choose  vectors  ^ , j = l,  2,  •••,  n, 

in  the  coordinate  directions  of  Rn. 

Step  2.  Find  q = q^)>  k=l,  2,  •••,  n,  which  minimize 

f (2L< 1 > + q ^k^),  where 

Z<°>  - X(1) 

y<k>  - yO-1)  + ,<k>S<k\  k - 1.  2 n 

and  i is  the  number  of  iterations  which  have 


been  completed. 
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Figure  2.6  Flow  chart  for  Powell's  method 
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Step  3.  Find  the  integer  m,  l<m<n  for  which 
A = f(y(m_1))  - f(y(m)) 
is  the  largest  . 


Step  4 . 


.(0) 


(n) 


Define  f^fCy^'),  f2  = f(yv“'), 
f3=f(2y(n)  - y(0)). 


and 


Step  5 . If  f 3^f ^ or 

(f x - 2 f 2 + f3)(f1  - f2  - A)2  > -5  (fL  - f3)2, 
put  X ^ ^ = y^  n ^ . Terminate  the  process  if 

||  X^+'*‘  ^ -X^  ^ ^ ||  2 is  sufficiently  small. 
Otherwise,  return  to  Step  2 with  the  same  set 
of  S(j\  j = l , 2 , . . . , n. 


Step  6.  If  neither  of  the  inequalities  of  Step  5 hold, 

define  s = y^n^-y^^  and  find  q = q which 

minimizes  f(y^n^+q  s).  Put  X^ ^ =y^ n^+q  s. 

Terminate  the  process  if  ||  X^+^  ^ -X^  ^ ||  ^ is 

sufficiently  small.  Otherwise,  return  to  Step 

2 with  the  new  set  of  vectors  S^  , ^ ^ , ..., 

s(n) 

> • • • y Q y 


g ( m~ 1 ) ^ s(m+l) 


s 
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2.4.4  Constrained  Optimization  Techniques 

The  optimization  problem  defined  in  Section  2.2  can  be 
rewritten  in  the  following  form: 

Minimize  f(X)  subject  to  the  constraints 
Cj(X)  < 0,  j = 1,  2,  . . . , p 

and  X 6 S,  -where  S is  some  given  set  in  Rn. 

The  set,  S = {X  | Cj(X)<0,  j=l,  2,  ...,  p},  is  called  the 
feasible  region.  If  the  constraints  are  linear,  the 
problem  is  considerably  easier  to  solve  than  if  they  were 
nonlinear.  If  both  the  objective  function  and  the 
constraints  are  linear,  then  we  have  a linear  programming 
problem,  the  solution  of  which  can  be  obtained  by  standard 
or  revised  simplex  algorithm  [20,  49].  We  shall  not 
discuss  the  simplex  algorithm  here. 

The  conditions  to  be  satisfied  at  a constrained 
minimum  point,  X , of  the  problem  can  be  stated  as  follows: 

3f  p 3C 

+ E A,  1 = 0,  i = 1,  2,  . . . , n (2.7) 

3Xt  j=l  3X. 

A.  C.  = 0,  j = 1,  2,  . . . , p (2.8) 

C.  < o,  j = 1,  2,  . . . , p (2.9) 


and 
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X j > 0,  j = 1,  2,  . . . , p (2.10) 

where  Xj*  j = l>  2,  p are  the  Lagrange  multipliers. 

These  conditions  are  called  Kuhn-Tucker  conditions  [21] 
after  the  men  who  developed  them.  A detail  derivation  of 
these  conditions  are  given  in  Appendix  A.  These  conditions 
are,  in  general,  not  sufficient  to  ensure  a relative 
minimum.  Sufficient  conditions  for  to  be  a relative 
minimum  of  the  problem  are  as  follows: 


9 f p 9 C 

+ E X . 1 = 

9X±  j=l  J9Xi 

0,  i = 1 , 2 , ...»  n 

(2.11) 

Xj  C.  = 0,  j = 

1 , 2 , • • • , p 

(2.12) 

c,  < 0,  j = 1, 

2 , ...»  P 

(2.13) 

Aj  > 0,  j = 1, 

2 , • • • , p 

(2.14) 

and 


n n 9 L 

E E dX 

i-1  k=  1 9Xi8Xk 


f is  positive\ 


\definite 


(2.15) 


where  L is  the  lagrange  function.  Some  good  general  dis- 
cussions of  the  optimality  conditions  are  given  in  [28,  58, 
59].  In  the  following  Sections,  we  shall  discuss  two  solu- 
tion techniques  for  solving  constrained  minimization 


problems . 
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Gradient  Projection  Method 

The  gradient  projection  method  of  Rosen  [26]  is  very 
efficient  for  solving  problems  with  linear  constraints. 
Although  the  method  has  been  described  by  Rosen  [27]  for  a 
general  nonlinear  programming  problem,  its  effectiveness  is 
mainly  confined  to  problems  in  which  the  constraints  are 
all  linear.  For  the  nonlinear  constraints,  very  small 
steps  must  be  taken,  and  a calculation  to  bring  the  new 
point  back  in  the  feasible  region  must  be  included  in  each 
cycle.  So  zig-zagging  will  frequently  occur  in  such 
situations . 

The  basic  idea  in  the  method  for  the  linear  cons- 
traints is  try  to  move  as  close  as  possible  to  the  direc- 
tion of  steepest  descent,  -Vf(X),  but  still  remain 
feasible.  If  moving  in  the  direction  of  steepest  descent 
would  cause  any  of  the  constraints  to  be  violated,  X is 
changed  along  the  projection  of  the  negative  gradient  of 
the  objective  function  onto  the  boundary  of  the  feasible 
region . 

Let  us  now  summarize  the  gradient  projection  algo- 
rithm. A flow  chart  of  this  procedure  is  shown  in  Figure 
2.7.  It  will  be  assumed  that  the  initial  point  x/ ^ ) is 
admissible  and  lies  in  the  intersection  Q'  of  q linearly 


independent  hyperplanes. 
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Figure  2.7  Flow  chart  of  the  gradient  projection  algorithm 
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Step  1.  Read  in  _X' ^ , the  objective  function  f ( X)  , 
the  constraints  and  tolerances.  Determine 
the  hyperplanes  H ^ , H2>  which 

form  the  intersection  Q'.  Set  i=l. 

T - 1 

Step  2.  Form  the  matrices  N and  [N  N 1 

q q q 

Calculate  the  gradient  vector  at  the  point 
3f^^/3X,  the  vector  r=[NT  N ] ^ NT 

- - — q q q 

[~9f^i)/^X]>  projection  matrix  P , and  the 

gradient  projection  [ - 3 f ^ ^ ^ ] . 

If  ||  P^ [ -3f ^ * V 3X]  ||  _<  and  r <_0 , where  r^ 

is  the  maximum  component  of  _r,  then  _X^  ^ is 
the  constrained  global  minimum  and  the 
procedure  is  terminated;  Otherwise,  go  to 
Step  3 . 

Step  3.  Determine  whether  or  not  a hyperplane  should 

drop  from  Q'.  If  ||  P [ ~3f  ^ ^ / 3_X  ] ||  <_£  ^ , drop 

the  hyperplane  , which  corresponds  to  r^XD, 

form  the  projection  matrix  P^_^,  and  go  to 

Step  4.  The  other  alternative  is  that  the 

norm  of  the  gradient  projection  is  greater 

than  e..  In  this  case,  calculate  $=max{ct-}> 

1 i 1 

where  a^sthe  sum  of  the  absolute  values  of  the 

T - 1 

ith  row  of  the  matrix  [N  N ] . If  r > 8 , 

q q q 
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drop  the  hyperplane  from  Q',  form  the 

projection  matrix  P and  go  to  Step  4.  If 

r < 3 » Q'  remains  unchanged. 

4 — 


Step  4.  Compute  the  normalized  gradient  projection 

z(  i ) 

Z(1 ) = (Pq  [- 3f  (i)/3X]  )/  1 Pq  [ -3  f (i)/8  X]  II 

and  the  maximum  allowable  step  size  x , where 

r m 

T is  the  minimum  positive  value  of  the  x.  's 
m J 

found  by  evaluating 

T . = ( v . - nT  X^1 ) )/nT  z( 1 ) 

J J -J  - -J  - 

for  j corresponding  to  all  hyperplanes  not  in 
the  intersection  Q*.  The  tentative  next  point 
X*(i+1)  i s found  from 


x»(i+l)  = + X 


m — 


Step  5.  Calculate  the  gradient  at  the  point  if 

^(l)T[-3f (X' (i+1^)/3X]  > 0, 

Set  X(i+1)=X' (i+1) ; since  X(l+1)  lies  in  the 
intersection  of  Q'  and  (the  hyperplane  which 

corresponds  to  the  step  size  determined  in 
Step  4),  add  to  Q',  and  return  to  Step  2. 

On  the  othter  hand,  if 

Z(i)T [-3f (X' (i+1) )/3X]  < 0 
find  X(1+1)  by  repeated  linear  interpolation 
as  in  Figure  2.8.  0=0  corresponds  to  the  point 
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Figure  2.8  Repeated  linear  interpolation 
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and  0=1  corresponds  to  the  point 
X'(i+1).  0^,  the  abscissa  where  the  straight 

line  from  A to  B has  an  ordinate  of  zero,  is 
determined  from  the  relationship 

z/i)T  [-af^/ax] 

1 Z^i)T  [-3f  (i^/3X]  - j^i)T  [ -3  f ' ('1+1)/3X] 
Next,  we  evaluate  the  gradient  at  the  point 

X„ ( i+ 1 ) = x(i)  + 0 T z(i) 

— — 1 m — 

and  form  the  inner  product 

Z(i)T  [ -3  f " (i+1)/3X] 

If  this  inner  product  is  positive,  we  use 
point  C and  B to  interpolate  again  ( if  the 
inner  product  had  been  negative,  point  C would 
have  a negative  ordinate  and  point  A and  C 
would  be  used  for  next  interpolation).  This 
procedure  is  repeated  until  a point  X^  ^ is 
found  where  the  magnitude  of  the  inner  product 
is  less  than  a preassigned  small  positive 
number  £ 2 > that  is, 

| z(i)T  [-  f (i+1)/  X] | < e2 

The  intersection  Q'  remains  unchanged,  and  the 
computational  algorithm  begins  another 
iteration  by  returning  to  Step  2. 
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Exterior  Penalty  Function  Methods 

The  basic  idea  of  penalty  function  algorithms  is  to 
reduce  the  constrained  problem  to  a sequence  of  uncon- 
strained problems  which  can  be  solved  by  the  methods  of 
Section  2.4.3,  the  solutions  of  which  converge  to  the 
solution  of  the  original  problem.  Let  the  original  opti- 
mization problem  be  the  form: 


Find  X which  minimizes  f ( X)  subject  to 
g (X)  = 0,  j = 1,  2,  ...,  ra,  and  (2.16) 

h_.  (X)  £ 0,  j = m+1,  m+2 , ...,  p (2.17) 


This  is  done  by  lumping  the  constraints  with  the  objective 
function  in  such  a fashion  that  minimizing  the  lumped 
function  penalizes  any  violation  of  the  constraints.  The 
lumped  function  can  be  shown  in  the  following  form: 


m 

U ( X , r ) = f (X)  + r Z G [g  (X) ] + 

j=l  3 J - 


j =m+l 


Hj lh. (X) ] 


(2.18) 


where  G.[g.(X)]  and  H.[h.(X)]  are  functions  of  the  con 
3 3 — 3 3 - 

straints  g . ( X)  and  h.(X),  respectively  and  r is  a positive 
3 J 

constant  known  as  the  penalty  parameter.  This  is  the  rea- 
son why  these  procedures  are  called  the  penality  function 
methods  and  also  known  as  "sequential  unconstrained  mini- 
mization techniques"  or  simply  SUMT . 
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Two  categories  of  penality  function  methods  exist, 
namely,  interior  methods  and  exterior  methods.  The  inte- 
rior methods  must  be  supplied  with  a feasible  starting 


successive  minimizations,  the  solution  of  the  constrained 
problem,  always  remaining  within  the  feasible  region,  are 
called  interior  methods.  The  exterior  methods  do  not  re- 
quire a feasible  initial  point,  and  generally  converage  to 
the  constrained  minimum  from  the  infeasible  region,  hence 
the  term  exterior.  The  exterior  methods  have  been  judged 
to  be  generally  superior  to  the  interior  methods  [60]. 

In  the  exterior  penality  function  methods,  the  lumped 
function  is  taken  as 


where  the  exponent  q is  a constant  greater  than  one,  and 


point,  X^).  As  the  penality  parameter  r is  varied  over 


m 2 

U(X,r)  = f(X)  + r Z [g.(X)]Z  + 

p J*1  „3 

r £ <h.(X)>q 

j-m+1  J 


(2.19) 


the  singularity  function  <h^(X)>  is  defined  as 


if  h j ( X)  > 0 


(constraint  is  violated) 


<h  j ( X ) > = < 


(2.15) 


0, 


if  hj(X)  < 0 


(constraint  is  satisfied) 
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It  can  be  seen  from  Equation  (2.19),  that  this 
formulation  is  to  assess  an  increasingly  severe  penality  on 
the  value  of  U(X,  r)  as  the  constraints  become  violated  by 
larger  amounts.  The  most  successful  way  to  find  the  true 
constrained  minimum  of  the  original  function  has  generally 
been  to  minimize  Equation  (2.19)  using  a small  value  for 
the  penalty  parameter  r for  the  first  minimization.  Sub- 
sequent minimizations,  until  the  solution  is  forced  to  con- 
verge in  the  feasible  region,  is  necessary.  This  is 
because,  if  r remained  small,  very  small  positive  values  of 
h_.(X)  and  small  errors  of  gj(X),  even  though  infeasible, 
would  not  contribute  much  of  a penalty  to  U (X , r)  and  the 
solution  might  remain  infeasible.  On  the  other  hand,  if  r 
were  made  initially  very  large,  the  contribution  of  f(X) 
would  be  negligible,  and  the  solution  may  not  converge  to 
the  minimum  f (X)  within  the  constrained  region.  In  other 
words,  the  effects  should  be  balanced,  so  that  the  solution 
is  urged  toward  the  minimum  of  f(X)  at  the  same  time  it  is 
also  being  forced  toward  the  feasible  region. 

The  flow  chart  of  an  exterior  penalty  function  method 
is  shown  in  Figure  2.9,  and  the  algorithm  is  outlined  in 
the  following  steps: 

Step  1.  Make  an  estimate  ) of  the  solution  of  the 

constrained  optimization  problem  and  suitable 


value  of  the  penalty  parameter  r. 


Set  i = l . 


50 


Figure  2.9  Flow  chart  of  the  exterior  penalty  function  method 
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Step  2.  Find  the  point  X^^  that  minimizes  the 
function 

m 2 

U(X,  r)  = f(X)  + r Z [g.(X)p  + 

P j'1  c 

r E <h.(X)>q 

j=m+l  J 

Step  3.  Test  whether  the  point  X ^ ^ ^ satisfies  all 

the  constraints.  If  X ^ 1 ^ is  feasible,  it  is 
the  desired  optimum  and  hence  terminate  the 
procedure.  Otherwise,  go  to  Step  4. 

Step  4.  Increase  the  penalty  parameter  r and  set  the 
new  value  of  i as  original  i plus  one,  and  go 
to  Step  2 . 

2 . 5 Conclusions  of  Optimization  Techniques 

This  chapter  is  not  intended  to  be  complete,  but  is 
intended  to  offer  some  basic  concepts  and  methods  which  are 
useful  in  a design  environment.  Many  other  methods  have 
been  proposed,  and  are  worthy  of  careful  consideration. 
There  is  no  algorithm  that  is  most  suitable  for  all 
optimization  problems.  Many  different  circumstances  can 
affect  the  choice  of  method.  There  are  many  papers  [55, 

60,  61,  62,  63]  that  give  some  guidance  in  choosing  a 
suitable  method  for  solving  a particular  problem  alongwith 
some  other  computational  details.  There  are  also  several 
geniunely  useful  textbooks  [64,  65,  66]  in  the  area. 


CHAPTER  3 


MODELING  OF  SERIAL  ROBOTIC  MANIPULATORS 
3 . 1 Introduction 

An  important  initial  step  in  the  analysis,  design,  or 
precision  control  of  a complex  mechanical  function 
generator,  such  as  a manipulator,  is  to  obtain  a 
representative  model  of  the  device.  The  model  must  be 
accurate  enough  to  give  results  which  satisfactorily 
describe  the  operation  of  the  actual  device,  yet  simple 
enough  to  be  of  practical  use.  To  satisfy  these 
requirements , the  rigid-link  manipulator  model  is  employed 
in  this  dissertation.  The  model  neglects  deformations  in 
the  links  and  joint  deformations  which  are  not  in  the 
direction  of  the  nominal  joint  motion.  This  is  a good 
approximation  for  industrial  manipulators  in  use  today 
since  most  (90%)  of  the  deformations  seen  in  industrial 
robot  structure  are  due  to  compliance  in  actuators  and 
associated  drive  train  components.  Although  some  flexible- 
link  derivations  of  manipulator  model  are  available  [67, 
68],  these  formulations  are  too  complex  to  be  of  much 
practical  use  with  near  term  computational  capabilities. 
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3 . 2 Kinematic  Arm  Representation 

The  serial  manipulator  is  represented  kinematically  as 
a sequence  of  rigid  links  jointed  by  one  degree  of  freedom 
lower-pair  connectors  as  shown  in  Figure  3.1.  Associated 
with  each  joint  are  two  geometric  parameters:  1).  (or 

S^)  --  the  offset  distance  along  the  joint  axis,  S_^  , 


between  the  two  links  which  the  joint  connects;  and  2).0 
(or  ®jj)  ““  the  relative  rotation  about  between  these 
two  links.  The  link  direction  between  the  successive 


j 


joints  j and  k is  represented  by  the  unit  vector  a.,  which 

— J K. 

lies  along  the  common  perpendicular  of  S.  and  S.  • The 

— j —K 

fixed  link  length,  ajjc>  is  the  distance  between  two 
successive  joint  axes  measured  along  the  a^^  vector.  The 
fixed  angular  rotation  of  to  is  and  is  the  angle 

taken  about  a^^  in  a right  hand  sense.  The  fixed  Cartesian 

Jc  jc  jc 

coordinate  system  (X  , Y , Z ) is  located  at  the  first 


joint  with  the  Z axis  along  S_^  . Each  link  has  a local 
coordinate  system  (X^^,  Z^^)  associated  with  it. 

The  X(  axis  is  along  the  a^  vector  and  Z ^ axis  is 
along  the  J3  . vector. 


3 . 3 Kinematics  of  Serial  Manipulators 

In  the  kinematic  analysis  of  manipulators  two  types  of 
problems  may  arise.  The  forward  kinematic  problem  involves 
determining  the  position,  velocity,  and  acceleration  of  all 
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Figure  3.1  Kinematic  representation  of  manipulator 
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point  in  the  manipulator  when  these  quantities  are  known 
for  the  independent  joint  coordinates  [41].  Many  straight 
forward  solutions  to  this  type  problem  exist  and  it  is  only 
necessary  to  determine  which  formulation  is  the  most 
efficient  in  a given  situation.  The  reverse  kinematic 
problem,  that  of  finding  the  required  joint  coordinates  in 
order  to  obtain  a desired  motion  of  the  hand,  is  much  more 
complicated  and  has  received  much  research  recently,  e.g. 
[69,  70]. 

In  general  there  are  two  approaches  to  the  reverse 
kinematic  problem.  One  is  an  iterative  numerical  solution 
[71]  in  which  the  present  location  is  used  to  determine  the 
joint  coordinates  of  the  next  desired  end-effector 
location.  The  other  approach,  which  is  considerably  more 
difficult,  is  to  establish  a closed-form  analytical 
procedure  [72]  in  which  the  joint  coordinates  can  be  solved 
for  any  hand  location  in  the  system  workspace.  Appendix  B 
employs  this  analytical  procedure  to  derive  a detailed 
position  analysis  for  an  example  industrial  manipulator. 


3.3.1  Positioning  of  the  Arm 


As  mentioned  in  Section  3.2,  there  are  two  coordinate 
systems,  the  absolute  and  body-fixed  references,  as  shown 
in  Figure  3.1.  One  of  the  most  popular  methods  for  arm 
positioning  involves  the  use  of  3x3  rotation  matrices.  Let 
Tj  represent  the  rotational  transformation  matrix  which 
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relates  the  j th  body-fixed  coordinate  system  to  a reference 
system  with  common  origin  to  the  j th  system  and  with  axes 
parallel  to  the  fixed  reference  axes.  If  _P^  ^ Is  a vector 

in  terms  of  the  local  jth  reference,  its  direction  P in 
terms  of  the  fixed  global  coordinates  is 


where  the  rotational  transformation  matrix  can  be  expressed 
as 


Tj  " [-jk  -jx^jk  — j 1 (3'2) 

The  location  of  the  origin  of  the  jth  reference  system  can 
be  defined  by  the  vector  . As  shown  in  Figure  3.1,  the 
position  vector  can  be  found  by  sequentially  summing  the 
link  lengths  and  joint  offsets  starting  at  the  fixed  base: 

j 

R . = S . S , + £ {a/  , \ a , ...  + SS}  (3.3) 

— J 1—1  u 1 ( m- 1 )m— (m- 1 )m  m— mJ 

m=  2 

Then,  the  transformation  locating  a point  P,  with  local 
coordinates  _P^  \ in  terms  of  the  fixed  reference  is 


P = R.  + T.P(j ) (3.4) 

-J  j- 

Equations  (3.2),  (3.3)  and  (3.4)  show  that  the 
position  of  any  point  in  any  link  of  the  manipulator  can  be 
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readily  evaluated  as  a linear  combination  of  the  unit 


vectors  S.  and  a.,  . The  S.  and  a.,  vectors  can  be  obtained 
-J  -J  k -j  -J  k 

recursively  from  the  initial  direction  cosines 


Sl  = (Xj,  Yj,  Zl)T 
= (0,  0,  1)T 


(3.5) 


— 12  ^ X 1 2 ’ Y 1 2 ’ Z12^ 
= (Cj,  Slt  0)T 


and  the  following  expressions  if  j>l: 


( * > 

f \ 

X. 

0 

J 

* 

Yj 

ii 

H 

(_i. 

1 

i — * 

"s(j-l)j 

* 

lZ3  J 

> G(j-1)jJ 

' Y*  1 

( \ 

j(j  + D 

c . 

j 

=< 

* 

Yj  ( j + 1) 

’ - Vi  ( 

C(j-Djsj 

,Zj(j  + D, 

ks(j-i)jsj, 

(3.6) 


(3.7) 


(3.8) 


where  is  defined  by  Equation  (3.2)  and  = Cos  9^ , 

Sj  = Sin  , etc.  Equations  (3.2  - 3.8)  illustrate  the  arm 
position  can  be  explicitly  determined  in  terms  of  the  fixed 
parameters  of  the  manipulator  geometry  and  the  input 
reference  parameters  which  representing  or  0^  . 
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3.3.2  Kinematic  Influence  Coefficients  for  Serial 
Manipulators 

Kinematic  influence  coefficients  have  been  used 
extensively  to  create  explicit  dynamic  model  formulations 
for  mechanisms  [45,  46,  47,  48,  73].  Reference  [5]  for  the 
first  time  develops  the  complete  rigid-link  dynamic  model 
for  all  conceivable  serial  link  manipulators  based  on  an 
exceptionally  accessible  set  of  kinematic  influence 
coefficients  which  are  tabulated  in  Table  3.1.  The 
philosophy  there  can  be  used  to  treat  N degree  of  freedom 
manipulator  to  evaluate  the  effect  of  certain  design 
parameters,  such  as  mass  content,  actuator  sizing, 
stiffness,  and  natural  frequencies,  ••.,  etc. 

Suppose  u.  = f ( <J>  ) represent  any  position  function  of 
a robot  structure.  The  first  and  second  order  kinematic 
influence  coefficients  are  the  derivatives  of  the  geometric 
position  function  u^  with  respect  to  the  input  reference 
parameter(s)  (j)^,  n=l,  2,  ...»  N. 


(3.9) 


and 


[H 


m n 


(3.10) 
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The  kinematic  influence  coefficients  in  Table  3.1  are 
provided  by  either  the  unit  vector  Sn  of  the  joint  axes  or 
products  of  similar  vectors.  Because  of  the  simplicity  and 
compact  notation  of  this  result,  real  time  modeling  of 
present  industrial  robotic  systems  becomes  a real 
possibility.  This  work  is  being  pursued  by  J.  Wander  [80] 
in  the  University  of  Florida. 


3.3.3  Velocities  for  Serial  Manipulators 

The  positioning  problem  is  by  far  the  most  demanding 
task  in  kinematic  analysis  and  synthesis  of  manipulators. 
Having  determined  the  joint  inputs  and  resulting  manipu- 
lator positions,  the  determination  of  velocities  and 
accelerations  is  direct.  The  absolute  velocity  in  a fixed 
reference  of  a link  jk  can  be  specified  by  the  three 
component  angular  velocities  of  the  link  and  the  trans- 
lational velocity  of  a certain  point,  P,  which  is  fixed  in 
the  link.  The  absolute  angular  velocity  of  link  jk  of  a 
serial  manipulator  is  obtained  from  the  angular  velocity 
addition  theorem  as  the  sum  of  the  relative  angular 
velocities  between  preceding  links  in  the  serial  chain 


3 • 

U)  = Z 0 S 
n=  1 n 


(3.11) 


where  6n  is  the  relative  angular  velocity  between  links  n-1 
and  n.  Those  joints  which  are  prismatic  joints  make  no 
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contribution  to  the  angular  velocity  (0^=0) . Equation 
(3.11)  can  be  rewritten  by  using  the  rotational  first-order 
influence  coefficients  in  Table  3.1  as 

wjk  = [Gjk]  1 (3.12) 

The  translational  velocity,  v of  a point  p which  is  fixed 
in  link  jk  can  be  found  by  differentiating  Equations  (3.3) 
and  (3.4)  with  respect  to  time  and  regrouping  terms,  then 
the  velocity  becomes 

ip  - S l^nSn  + enSn  x (P  - R„)]  (3.13) 

n=  1 

Since  each  joint  n has  only  one  degree  of  freedom,  one  of 

• • • 

the  two  terms  S and  6 is  identically  zero.  S is  zero 

for  revolute  joints  and  0^  is  zero  for  prismatic  joints. 
Therefore,  the  translational  velocity  of  point  P can  also 
be  written  in  terms  of  the  translational  frist-order 
influence  coefficients  as 

Zp  = [Gp]  ! (3.14) 

From  Equations  (3.12)  and  (3.14),  the  resultant 
expressions  for  velocity  will  represent  six  equations  which 
are  linear  in  the  N joint  velocities.  Therefore,  the 
equations  can  be  written  as 
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fVn  1 

'[gj 

^ = 

__E__ 

\ 

*r-> 

_3J 

_ tGjk]  . 

(3.15) 


The  velocity  of  the  manipulator's  end-effector  can  be  ex- 
pressed in  a similar  manner.  Let  be  the  hand  velocity 
which  consists,  in  general,  of  three  components  of  its 
angular  velocity  uh=(Jjj(n+1)  and  three  components  of  the 
translational  velocity  _v^  of  the  reference  point  H in  the 
end-effector.  Then  the  six  element  vector  _V^  and  <j)  are 
related  by 


— H 


n 

Dd 

[>l 

l 

I 

I 

i 

i 

I 

as  i 

O 1 

1 

l-N(N+l)J 

_ [GN(N+1) L 

or 


vH  = [J]± 


(3.16) 


(3.17) 


Here,  the  6xN  matrix  [J]  is  the  Jacobian  for  the  hand 
motion  defined  as 


[J] 


£®h! 

_ [GN(N+1) 1 


(3.18) 


The  elements  of  the  Jacobian  [J]  are  complex  functions  of 
the  joint  positions  and  link  geometries  and  are  directly 
calculable  once  these  joint  values  have  been  determined. 

For  six  degree  of  freedom  manipulators,  if  the  hand 
velocity  is  known,  the  necessary  joint  velocities  may  be 
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found  by  inverting  [J]  in  Equation  (3.17) 

A = Ih  (3-19) 

However,  even  for  six  degree  of  freedom  arms,  there  are 
numerous  configurations  of  the  arm  in  which  [J]  is 
singular.  When  [J]  is  singular,  some  rows  or  columns  of 
the  matrix  become  linearly  dependent  rows  or  columns  and 
the  rank  of  [J]  is  reduced.  Realizing  these  facts,  some 
singularities  can  be  overcome  by  finding  the  rank  of  [J] 
and  striking  out  the  linearly  dependent  rows  and 
corresponding  columns  in  [J].  The  resulting  square  matrix 
is  non-singular  and  may  be  inverted  to  find  the  independent 
joint  motions. 

The  Jacobian  for  redundant  system,  however,  is 
nonsquare  and  hence  is  not  directly  invertable.  Some 
consistent  ways  are  needed  to  obtain  the  joint  motions.  A 
convenient  criterion  can  be  defined  as  [8] 

Minimize  fl  j>J|  2 = [w|]  cjj ) 1 ^ 2 

Subject  to  V_H  = [J]  (j) 

in  order  to  solve  for  the  joint  velocities  where  [W  ] is  a 
symmetric  positive  definite  NxN  weighting  matrix.  The 
Lagrangian  for  the  constrained  problem  can  be  formulated  as 
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L - II  ± t + (Ih  " iT  [ J ] > A 


(3.20) 


where  X is  the  Lagrangian  multiplier  vector.  Differentia- 
ting  L with  respect  to  (p  and  X produces  a set  of  linear 
equations . 


TTi  ' 0 ' t"|li  - lJlTA 

a (p 


9L 

= 0 = - (j)T  [J] 

3X  “H  “ 

or 


i = [w?]-1  [j]tx 


Ih  = [J]i 


(3.21) 

(3.22) 

(3.23) 

(3.24) 


Substituting  Equation  (3.23)  into  Equation  (3.24),  we  get 


A = ( [J] [W|]-1[J]T)-1  VH  (3.25) 

From  Equations  (3.23)  and  (3.25),  the  joint  velocities  can 
be  obtained  as 


i = [w|]  1[J]T( [J] [w|]_1 [ J]T)  1 vH 


(3.26) 
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3.3.4  Accelerations  for  Serial  Manipulators 

Having  determined  serial  manipulator  positions  and 
velocities,  the  determination  of  accelerations  is  straight 
forward.  The  angular  acceleration  of  link  jk  can  be  found 
by  differentiation  of  equation  (3.12)  to  obtain 


V ■ ‘V  i + !Gjk'  1 


(3.27) 


Note  that  [H.,  ] is  considered  an  NxN  array,  each  component 
Jk 

of  which  is  a vector  of  length  three.  The  joint  velocities 
and  accelerations  are  kept  explicit  by  introducing  the 
kinematic  influence  coefficient  matrices.  Analogously,  the 
translational  acceleration  of  a point  in  link  jk  is  given 
by  differentiating  Equation  (3,14)  with  respect  to  time  and 
writing  this  acceleration  as 


ip  = i i + iGpi  i 


(3.28) 


Equations  (3,27)  and  (3.28)  show  that  the  accelerations  can 
be  calculated  as 


fa 

-p 

ii 

• T • 

! tHp]  ± 

. + 

[V 

a . , 

' — J kj 

iT  [Hjku 

(3.29) 


The  acceleration  of  the  end-effector  is  completely 
specified  by  its  angular  acceleration,  aH  = aN(j^+i)  and  the 
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translational  acceleration  of  the  hand  reference  point,  a.^  , 
as  shown  in  Equation  (3.29).  The  hand  acceleration  is 
related  to  the  joint  velocities  and  accelerations  as 


f 

. T 

. 

i 

[nH]  i 

:t 

$ 

• 

fHN(N+l)^  i 

+ m '<p 


(3.30) 


Using  the  symbol  A^  to  denote  the  ve 1 oc i ty- r e la t ed  terms  of 

H 

the  hand  acceleration 


• rr»  • 

i [Hh]  i 

• rp  • 

! [rn(n+i)1  i 


(3.31) 


and  assuming  the  Jacobian  is  nonsingular,  Equation  (3.30) 
can  be  rewritten  to  get  the  joint  accelerations  corre- 
sponding to  the  velocity-related  acceleration  and  hand 
acceleration 


I = [J]  1 - A^} 


(3.32) 


This  equation  again  stresses  the  importance  of  the  first- 
order  influence  coefficients,  or  the  Jacobian. 

Since  the  Jacobian  is  not  directly  invertible  for  a 
redundant  system,  a criterion  is  defined  here  in  order  to 
get  the  joint  acceleration  by 
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Minimize  f II2  = ($_T  [W^]  ^ ^ 

V ** 

subject  to  AH  = Ajj  + [J]  4>. 


where  [W^]  is  a symmetric  positive  definite  NxN  weighting 
matrix.  The  Lagrangian  can  be  expressed  as 


L = II  i ll2  + AT  {Ah  - Ah  " 


(3.33) 


Using  the  classical  optimization  techniques,  the  necessary 
conditions  for  an  extreme  of  the  constrained  problem  are 


$ = [ W-J  ] “ 1 [ J ] TA  (3.34) 

— <P  “ 

AH  “ Ah  = I (3.35) 

Substituting  Equation  (3.34)  into  Equation  (3.35),  we  get 

A = ( [J] [W|]'1[J]T)"1{AH  ~ Ah}  (3.36) 


From  Equations  (3.34)  and  (3.36),  the  joint  acceleration 
can  be  obtained  as 


I = [w|]  1 [ J]T(  [J]  [w|]  ^j]1)  1 (Ah  - Ah)  (3.37) 

A similar  equation  is  derived  as  Equation  (3.26).  From 
these  equations  the  selection  of  coordinates  for  motion  is 
arbitrary,  and  the  kinematic  influence  coefficients  are 
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proved  a useful  basis  for  changing  reference  systems  [74], 
In  manipulator  design,  the  designer  may  prefer  to  specify 
motion  capabilities  in  terms  of  end-effector  speeds  and 
accelerations  in  the  design  processes. 

3 . 4 Dynamics  of  Serial  Manipulators 

The  relations  between  the  manipulator  joint  variables 
and  the  time  states  of  the  links  in  a manipulator  are  need- 
ed for  the  dynamic  analysis  and  response  of  the  manipu- 
lator. The  dynamic  equations  of  motion  must  be  formulated 
in  a concise  and  efficient  manner  in  order  to  be  of  use  in 
the  control  and  design  of  manipulators.  A complete  dynamic 
model  is  needed  for  manipulator  control  in  order  to  deter- 
mine the  required  input  forces  and  torques,  to  evaluate  the 
deformations  due  to  loads  and  precision  of  the  arm,  to 
determine  control  properties,  etc.  In  manipulator  design 
it  is  essential  to  be  able  to  recognize  the  dynamic  effects 
of  all  parameters  and  the  load  imposed  on  the  actuators  for 
deciding  on  link  and  actuator  sizing  requirements.  By 
evaluating  the  significance  of  the  distribution  of  mass  and 
stiffness  parameters  it  may  be  possible  to  adjust  these 
parameters  to  obtain  higher  lowest  natural  frequency  and  to 
enhance  controllability,  especially  when  precision  control 
under  external  disturbance  is  required. 

Based  on  the  kinematic  influence  coefficients  and  the 
actual  mass  of  the  arm,  inertial  modeling  matrices  of  the 
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serial  manipulators  were  developed  for  the  first  time  in 
the  work  [5]  by  Thomas  and  Tesar.  These  modeling  matrices 
indicate  the  effect  at  the  inputs  of  applied  and  inertial 
loads.  The  model  leads  to  a simplified  form  of  dynamic 
equations  of  motion  for  the  rigid-link  arm.  The  work  must 
be  considered  as  the  foundation  to  this  dissertation  and 
will  be  briefly  reviewed  in  the  next  two  sections.  Other 
dynamic  phenomena,  such  as  actuator  stiffnesses  and  natural 
frequencies  for  the  rigid-link  manipulator  model,  will  be 
derived  by  using  the  kinematic  influence  coefficients. 


3.4.1  Input  Torques  Due  to  Applied  Loads 


The  terminal  device  of  a manipulator  is  usually 

subjected  to  some  general  loading  conditions  during 

execution  of  a task.  For  example,  this  might  be  a 

resisting  force  and  a resisting  torque  resulting  from  a 

hole-drilling  operation.  In  the  most  general  case,  several 

forces  and  torques  can  be  applied  to  different  points  and 

links  in  the  manipulator.  The  effective  load  at  each 

actuator  due  to  these  applied  loads  can  be  explicitly 

derived  in  terms  of  the  first-order  influence  coefficients 

for  the  points  and  links  of  load  application. 

First,  consider  the  applied  loads  on  link  jk  of  the 

manipulator  as  a force,  f^,  applied  to  point  P in  the  link 

( ik) 

and  a moment,  m.,  , applied  to  the  link.  Let  F J 
— j K n 

represent  the  effective  torque  (or  force,  for  prismatic 
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joints)  on  actuator  n due  to  these  applied  loads  and  the 
method  of  virtual  work  can  be  used  to  determine  an 
expression  for  this  quantity  as 


F(  jk) 
n 


T 

[G  ] 

L p J n 


f + 
-P 


T 

n 


m 

-Jk 


(3.38) 


Assuming  that  the  force  f_H  and  moment  Bn(N+1)  at  t*ie  ^and 
are  the  only  externally  applied  load  on  the  arm,  the 
effective  loads  at  the  joints  can  be  written  as 


*4  = 


Ih 


(3.39) 


where  F>  -[fJ<N+1>.  F»<N+1>,  ....  F*<N+1>]T  and  Ffi  = [fj. 


— N(N  + 1)^  ’ From  Equations  (3.17)  and  (3.39),  the  Jacobian 

provides  a general  transfer  concept  of  velocities  and  loads 
between  the  generalized  input  coordinates  and  the  fixed 
coordinates  (see  Figure  3.2). 

The  total  effective  load,  FL , at  actuator  n due  to 
applied  loads  is  found  by  summing  the  effective  load  from 
each  applied  force  and  torque: 


P N 

F*;  = 2 ( f T [ G ] ) + I (m  .,  [ H ] ) 

n p = 1 - 1 pJny  -J kL  jk J n 


(3.40) 


where  P is  the  total  number  of  load  points  of  interest  in 


the  manipulator. 
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Figure  3.2  Linear  velocity  and  load  transformations 
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3.4.2  Input  Torques  due  to  the  Inertial  Loads 

In  this  section  the  effective  actuator  torques  due  to 
the  system  inertia  and  a given  dynamic  state  are  presented. 
The  NxN  modeling  matrices  [I  ] and  [P*]  (n  = 1,  2,  ...,  N) 

will  be  expressed  in  terms  of  the  link  mass  distributions 
and  the  kinematic  influence  coefficients. 

The  kinetic  energy  of  a rigid-link  manipulator  in 
motion  can  be  expressed  as  the  sum  of  the  kinetic  energies 
of  the  individual  link  in  the  form 


K.E.  - (1/2)  Z (M.k  Vc.  + [Hjkl  <£Jk)  (3.41) 


where  M ^ ^ is  the  mass  of  link  jk,  V.  t*le  vel°city  of 

the  centroid  of  link  jk,  and  [11^]  is  the  3x3  inertia 
tensor  about  the  centroid  for  link  jk.  The  kinetic  energy 
of  the  system  can  be  rewritten  explicitly  in  terms  of  the 
joint  velocities  and  the  first-order  influence  coefficients 
by  using  Equations  (3.12)  and  (3.14),  and  is  given  as 


N • T T ’ 

K.E.  = (1/2)  2 (M  * [G  ] [G  ]$  + 

2=1 

iTtG,k]T[Hjk]  [Gjk]  iT) 


jk 

= (1/2)  iT [ i* ] i 


(3.42) 


where  [I  ] is  the  equivalent  inertia  matrix  which 
represents  the  effective  system  mass  seen  at  each  input. 
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The  scalar  component  in  row  m and  column  n of  this  matrix 
is  defined  as 


[I*] 


m ; n 


N 

= E 

2=1 


(M.,  [G  . ] [6  . ] + 

J k cj  m cj  n 

[G..  ]T  [II..  ] [ G . , ] ) 

j k J m jkJ  1 jkn 


(3.43) 


The  equivalent  inertia  matrix  depends  only  on  the  mass 

properties  of  the  links  and  the  corressponding  first-order 

influence  coefficients.  Since  the  inertia  matrix  [II_.^]  is 
* 

symmetric,  [I  ] is  also  a symmetric  matrix. 

The  generalized  inertia  torques,  i.e.,  the  actuator 

torques  required  for  driving  the  system  inertia  with  a 

/ 

prescribed  arm  velocity  and  acceleration  can  be  obtained  by 
using  Lagrange's  equations  given  as 


3 K . E . 


n 


dtV^^ 


3K.E  . 


3<}) 


(3.44) 


Differentiation  of  Equation  (3.42)  together  with  Equation 
(3.44)  leads  to 


Fn  = ITU*];n  + AT  [P*l  i (3-45) 

where  [I- ] > represents  column  n of  the  equivalent  inertia 
5 ft 

* 

matrix  and  [P  ] is  the  inertia  power  modeling  matrix.  The 
scalar  component  in  row  t and  column  m of  [ P n ] can  be 


expressed  as 
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[Pn]£;m  = S 


^Mjk  tHcj  ^ £;m  ^Gcj  ^ n + 

[IIjkl  ^jkU  + 


[Gjk] 


I^Jkl  ([GjkJn  x tGjkV>  <3*46> 


The  inertial  modeling  matrices  defined  by  Equations 
(3.43)  and  (3.46)  indicate  the  physcial  nature  of  the  sys- 
tem in  a given  configuration  and  depend  only  on  the  posi- 
tion, geometry  and  mass  distribution  of  the  manipulator. 
The  inertia  torque  in  Equation  (3.45)  which  each  actuator 
must  supply  to  drive  the  manipulator  at  the  prescribed 
velocities  and  accelerations  can  now  be  readily  evaluated 
using  the  inertial  modeling  coefficients.  Note  this  iner- 
tia torque  has  two  components:  1).  an  acceleration  related 

term,  and  2).  a component  which  depends  on  the  quadratic 
form  of  joint  velocities.  Massive  manipulators  and  in- 
creased speeds  of  operation  make  the  inertia  torque  even 
more  important  in  the  control  and  design  of  modern 
manipulators  . 


3.4.3  The  Generalized  Actuator  Stiffness  Matrix 

Since  the  hand  of  a manipulator  is  subjected  to  some 
applied  loads  during  operations,  the  compliance  and 
deformation  are  distributed  throughout  its  structure. 
Position-dependent  influence  coefficients  again  form  a 
convenient  basis  for  modeling  actuator  stiffness  and 
compliance  . 


The  deflection,  AR^ , at  the  end -effector  of  a 
manipulator  due  to  an  applied  load,  , at  the  hand  can  be 
written  as  [ 75 ] 


“h  ■ IchI  -h 


(3-47) 


where  [C.,]  is  a 6x6  position-dependent  compliance  matrix. 
In  general,  the  vectors  in  Equation  (3.47)  contain  three 
translational  and  three  rotational  components.  Assuming 
that  the  flexibilities  in  the  joint  drives  are  the  most 
significant  compliance  terms,  the  effective  compliance 
matrix  can  be  expressed  in  terms  of  the  first-order 
coefficients  [J]  that  relate  the  motion  at  the  hand  to  the 
joint  motions . 

The  effective  torques  F^  at  the  joints  due  to  a load 
F applied  at  the  end-effector  reference  point  H are  given 
in  Equation  (3.39).  Using  Hooke's  law  for  elastic 
deformations,  the  deflections  Aj^  at  the  joints  of  a 
manipulator  due  to  the  effective  torques  _F^  can  be  written 
as 


A!  = (V  IcJ,  (3.48) 

where  [ C ^ ] is  a NxN  diagonal  matrix  of  joint  flexibilities. 

The  deflection  Ar  at  the  hand  due  to  the  joint  deflections 

— H. 


can  be  expressed  as 
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ARH  = [J]  A_£  (3.49) 

substituting  Equations  (3.39)  and  (3.48)  into  Equation 
(3.49),  the  compliance  matrix  of  equation  (3.47)  in  the 
fixed  coordinate  system  is 

[CH]  = [ J] [C^] [ J]T  (3.50) 

[ CR]  is  generally  symmetric  but  not  diagonal,  i.e.,  forces 
in  one  direction  can  produce  hand  deflections  in  several 
directions.  The  6x6  stiffness  matrix  [K^]  in  the  fixed 
reference  of  the  equation 

[Kh]  ARh  = Ih  (3.51) 

can  be  obtained  by  inverting  the  matrix  [C^] 

[Kh]  = [ J ] _T [ ] [J]'1  (3.52) 

where  the  -T  superscript  indicates  the  transpose  of  the 
inverse  of  the  matrix  and  [ ] is  a NxN  diagonal  matrix  of 
the  joint  stiffness. 

3.4.4  Vibrations  of  Serial  Manipulators 


An  important  issue  in  many  manipulator  tasks  is  the 
accuracy  of  the  motion  obtained.  There  are  two  distinct 
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types  of  structural  deformations  which  limit  this  accuracy. 
These  are  referred  to  here  as  deformations  in  the  large  and 
vibrations  in  the  small.  Vibrations  in  the  small  are  low 
magnitude,  oscillatory  deformations  about  the  mean  motion 
equilibrium  as  distinct  from  the  deformation  in  the  large 
which  result  from  static  loads.  Vibrations  in  the  small 
are  caused  by  transient  phenomena  acting  on  the  system  such 
as  from  startup  and  stopping  of  the  arm  motion.  The  lowest 
natural  frequencies  of  vibration  are  a good  indicator  of 
overall  structural  integrity  of  the  manipulator  and  can 
lead  to  important  design  and  control  considerations. 

For  today's  industrial  manipulators,  most  of  the 
deformation  energy  of  vibration  appears  in  actuator  and 
drive  train  components.  Therefore,  the  rigid-link 
manipulator  model  which  considers  flexibility  at  joint  in 
the  direction  of  relative  joint  motion  is  a good 
approximation  for  industrial  robots.  The  model  in  this 
case  is  identical  to  that  formulated  in  Section  3.4.2,  with 
spring  terms  K contributing  to  actuator  torques.  Assuming 

~<l> 

the  vibrational  deformations  are  small  and  the  system 
damping  is  negligible.  Let  A(j>n  be  a small  magnitude  of 
vibrational  deformations  about  the  gross  motion  equilibrium 
position  at  joint  n,  or 

“ ♦n, nominal  + ^n  (3.53) 
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Since  vibrations  about  an  equilibrium  configuration  are 
being  considered,  the  gross  motion  torques  balance  in  the 
equations  of  motion  and  Equation  (3.45)  leads  to  the 
vibrational  equation  of  motion  at  joint  n in  the  form: 


A$T[I*]  + A4)T  [ P*  ] Ai-  -K  A <() 

— ; n — n — n n 


(3.54) 


where  the  [I  ] and  [P  ] are  the  inertial  modeling  matrices 
which  are  given  in  Equations  (3.43)  and  (3.46), 
respectively.  Aj£  is  the  vector  of  joint  deflections  and 
is  the  stiffness  at  joint  n. 

The  vibrational  motion  at  each  joint  can  be  written  as 
the  superposition  of  N cyclic  terms 

N 

A<j>  = E $ . Sin  03. t,  n = 1,  2,  ...,  N (3.55) 

n j=l  nJ  3 


where  is  the  magnitude  frequency  w 

one  mode  of  vibration  at  a time  leads 
dependence  for  the  vibrational  motion 


j* 

to 


Considering  only 
the  following  time 


A*n 

= $ Sin  ojt 
n 

(3.56) 

A^n 

= $ 03  Cos  03t 

n 

(3.57) 

2 

A0n 

= - 0 o)  Sin  cot 
n 

(3.58) 

Performing  an  elementary  order  analysis  by 
substituting  Equations  (3.56),  (3.57)  and  (3.58)  into 
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Equation  (3.54),  the  resulting  equation  indicates  that  the 


magnitudes  of  vibration.  To  show  this,  compare  the 
relative  magnitudes  of  the  two  terms  on  the  left  side  of 
Equation  (3.54).  The  components  of  [I  ] are  of  same 

•Jp 

magnitude  or  slightly  larger  than  the  components  of  [P  ]. 


Assuming  that  the  vibrational  deformations  are  less  than 
+3°  (a  very  large  motion  for  a precision  manipulator)  gives 


This  implies  that  less  than  one-twentieth  of  the  inertia 
torque  due  to  vibration  is  in  the  velocity-related  term  so 
this  term  can  be  neglected. 

Equation  (3.54)  and  this  approximation  lead  to  the 
reduced  linear  equations 


Similarly,  the  magnitudes  of  A<j>n  and  A<j>n  A<f>m  ate  of  the 
order 


(3.59) 


(3.60) 


(3.61) 


A$T  [I*]  + K A<j>  = 0, 

-t  ; n n Tn 


n = 1 , 2 , 


• • • » 


N (3.62) 


Substituting  for  A<J>n  and  A$n  from  Equations  (3.56)  and 
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(3.58)  and  writing  the  equations  for  all  N joints 
simultaneously  gives  the  set  of  equations. 


(0)2[I*]  - [K  ])  $ = 0 

<j)  - 


(3.63) 


where  [K,]  is  the  NxN  diagonal  matrix  of  joint  stiffness 

<P 

T 

and  §_=  [ $ , $ 2 * • • • > $N  ] is  the  vector  vibration  amplitudes. 
This  is  a standard  eigenvalue  problem.  For  $n  are  not  to 
be  all  zero,  then  the  determinant  of  the  coefficient  matrix 
must  vanish;  that  is, 


,2  r * 


2 * 
<*>  [I  1 


2 r -r* 


w [I  I , . ,-K.  0)  [I  ] 


i ; 1 "l 

2;  1 


1 ; 2 

“2[I*12;2-K2 


1 ; N 


2 r * 

• • . u [I  1 2 ; N 


= 0 (3.64) 


? r * 

] 


N ; 1 


1 r * 

w2[I  ] 


N;  2 


' ' * W ^ 1 ^ N ; N KN 


The  evaluation  of  the  determinant  results  in  an  Nth-degree 

2 

algebraic  equation  in  0)  . The  N roots  of  the  charac- 
teristic equation  are  the  square  of  a natural  frequency 
(usually  expressed  in  rad. /sec.).  It  can  be  shown  from 
matrix  theory  that  the  roots  w are  all  real  and  finite  if 
the  kinetic  energy  given  in  Equation  (3.42)  is  positive 
definite  and  if  both  [I  ] and  [ ] are  real  symmetric 
matrices.  The  eignvalues  must,  in  general,  be  solved  for 
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numerically.  Several  methods  of  solution  are  available  for 
determination  of  a few  or  all  eigenvalues  and  eigenvectors 
of  the  coefficient  matrix,  such  as  the  Power  method,  the 
classical  Jacobi's,...,  etc. 

3 . 5 Conclusions  of  Modeling  of  Robotic  Manipulators 

The  underlying  philosophy  of  this  chapter  has  been  the 
dependence  of  all  kinematic  relationships  as  functions  of 
input  parameters.  The  trend  evident  is  the  separation  of 
the  dynamic  state  from  that  which  is  solely  kinematic.  The 
kinematic  properties  are  well  known  to  be  purely 
geometrical.  The  kinematic  influence  coefficients  can  be 
tabulated  in  an  array  as  the  dynamic  modeling  blocks.  Once 
the  geometry  can  be  formalized  in  a logical  manner,  the 
superimposed  dynamics  problem  becomes  elementary. 

The  nature  of  the  dynamic  model  derived  in  this 
chapter  can  be  concluded  as  follows: 

1) .  Kinematic  influence  coefficients  are  fundamental 

to  the  dynamic  model. 

2) .  All  influence  coefficients  can  be  calculated  from 

extremely  elementary  vector  operations. 

3) .  Model  retains  explicit  role  of  all  dynamic  system 

parameters . 

4) .  Potential  exists  for  real  time  modeling  operation. 


CHAPTER  4 


KINEMATIC  AND  DYNAMIC  ANALYSIS 
OF  ROBOTIC  MANIPULATORS 

4 . 1 Introduction 

In  the  design  of  mechanical  systems  it  is  often  neces- 
sary to  investigate  the  performance  of  a system  when  one  or 
more  parameters  of  the  system  varies  over  a given  range, 
because  better  design  of  manipulators  requires  improved 
understanding  of  the  geometric  and  dynamic  aspects  of  the 
important  parameters.  Since  the  model  parameters  presented 
in  Chapter  3 play  an  important  role  in  the  dynamic  behavior 
of  robotic  manipulators,  an  important  problem  in  manipu- 
lator design  is  the  investigation  of  the  influence  of  the 
important  parameters  in  the  workspace  of  a manipulator. 

Based  on  the  dynamic  model  formulation  given  in  the 
previous  chapter,  an  analysis  of  the  dynamic  characteris- 
tics of  a six  degree  of  freedom  industrial  manipulator  is 
illustrated  in  this  chapter.  The  analysis  on  which  to  base 
the  design  methods  involves  the  multivariable  mathematical 
relations  between  the  design  parameters  and  the  manipula- 
tor's force  and  motion  states  which  are  extraordinarily 
complex,  nonlinear,  and  highly  coupled.  Computer-aided 
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complex,  nonlinear,  and  highly  coupled.  Computer-aided 
procedures  are  imperative  for  the  kinematic  and  dynamic 
analysis  in  order  to  understand  the  influence  of  the 
system.  Computer-generated  manipulator  and  parameter 
contour  plots  are  employed  to  display  the  extensive 
analysis  information  in  a compact  format  and  to  help  the 
designer  to  develop  an  intuitive  feel  for  his  problem 
re-enforced  by  the  visual  displays.  The  digitial  computer 
has  allowed  the  designer  not  only  to  quantitatively  analyze 
the  behavior  but  also  to  examine  it  qualitatively. 

4.2  Arm  Characteristics  for  the  Industrial  Robot 


The  manipulator  investigated  in  this  report  is  a large 
capacity  six  degree  of  freedom  industrial  type  arm.  Figure 
4.1  contains  a representative  drawing  of  the  manipulator 
showing  its  six  rotational  axes.  Each  of  these  revolute 
joints  is  driven  by  an  electrical  DC  motor.  The  second  and 
third  axes  are  driven  by  two  ballscrews  which  transfer  the 
rotary  motions  from  the  drive  DC  motors  to  the  linear 
motions  along  their  axes.  The  wrist  is  one  of  its  out- 
standing features.  All  three  axes  of  the  wrist  are 
intersected  at  the  same  point  and  each  axis  is  capable  of  a 
full  360  degree  rotation.  Due  to  the  last  two  twist 
angles,  it  allows  the  end  effector  to  be  placed  anywhere  in 
a 238  degree  cone  with  continuous  rotation  about  the  last 


axis  . 
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Elbow  axis 


Three  axis  wrist 


Figure  4.1  Six  degree  of  freedom  industrial  robot 
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The  kinematic  representation  of  the  industrial  robot 
using  the  notation  established  in  Chapter  3 is  displayed  in 
Figure  4.2.  Table  4.1  lists  the  corresponding  kinematic 
parameters  and  the  joint  motion  ranges.  Because  several 
link  lengths  and  offsets  are  zero,  the  industrial  manipula- 
tor is  a special  geometry  of  the  general  6R  robot  and  its 
position  analysis  simplifies  considerably  from  the  general 
case.  Appendix  B presents  a detailed  derivation  of  the 
reverse  position  analysis  employed  for  the  rest  of  this 
work  . 

The  principal  dynamic  properties  of  interest  are  the 
mass,  rotational  inertia,  and  the  location  of  mass  centroid 
for  each  link.  Table  4.2  lists  the  dynamic  properties  for 
the  example  industrial  robot.  The  hand  reference  point  for 
this  analysis  is  defined  at  the  origin  of  the  local 
coordinates  for  link  6.  The  hand  location  coordinates  ( , 
Y^,  Z^)  refer  to  the  position  of  this  point. 

4 . 3 Workspace  of  the  Industrial  Manipulator 

Most  of  the  performance  characteristics  of  a robotic 
manipulator  are  functions  of  position  and  configuration  in 
its  workspace.  Hence  it  is  very  important  and  useful  to 
characterize  the  workspace  of  a manipulator  and  analyze  the 
important  parameters  in  the  workspace. 

Figure  4.3  shows  the  workspace  of  the  example  robot  in 
the  X -Z  plane  (Y  =0) . The  working  volume  of  the 


85 


—34 


Figure  4.2  Kinematic  representation  of  the  example  manipulator 
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Table  4.1  Kinematic  parameters  of  the  example  manipulator 


Joint 

No. 

a., 

jk 

(deg.) 

a.. 

jk 

(in.) 

S.  . 9 . 

3 3 min 

(in.)  (deg.) 

0 

max 

(deg.) 

1 

90 

0 

32  -135 

135 

2 

0 

44 

0 30 

117 

3 

90 

0 

0 -45 

60 

4 

61 

0 

55  -180 

180 

5 

61 

0 

0 -180 

180 

6 

0 

6 -180 

180 

Table  4. 

2 Inertia 

properties 

for  the  example  man 

ipulator 

Link 

Centroid 

Mass 

Inertia 

X Y 

Z 

I I 

I 

x y 

z 

(in.) 

(1V 

3 2 

(10  lb  -in.  about  centroid) 
m 

1 

0 0 

-17 

700 

0 0 

100 

2 

20  -1 

0 

1500 

20  180 

150 

3 

4 -7 

0 

1000 

170  26 

170 

4 

0 0 

-20 

150 

2 2 

1.2 

5 

0 0 

0 

80 

0.8  0.8 

0.3 

6 

0 0 

-4 

60 

0.4  0.4 

0.2 
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X ( in . ) 

* * 

Figure  4.3  Workspace  of  the  industrial  robot  in  the  X -Z  plane 
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industrial  robot  is  limited  by  its  geometry  and  the  limits 

on  the  joint  rotations  as  listed  in  Table  4.1.  Although 

only  the  X -Z  plane  of  hand  locations  is  shown,  all  other 

reachable  hand  positions  can  be  achieved  by  rotating  this 

plane  about  axis.  Such  a rotation  requires  only  a 

change  in  the  value  of  first  joint  angle,  so  results  for 

the  entire  working  volume  can  be  obtained  by  a 

straightforward  transformation  of  the  results  presented  in 

k k 

the  workspace  of  the  X -Z  plane. 

In  the  following  analysis  of  this  chapter  and  next 
chapter,  the  orientation  of  the  hand  is  held  constant  as 
S =(  1 0 0)T  and  a,7=(0  1 0)T,  and  the  hand  reference  point, 

* k 

or  tool  center  point  is  moved  throUghtout  the  X -Z  plane. 

* * 

Figure  4.4  shows  the  effective  workspace  of  the  X -Z  plane 

for  the  hand  orientation.  Comparing  these  two  workspaces, 

it  is  clear  that  the  reachable  workspace  in  Figure  4.4  has 

k k 

been  significantly  reduced  in  the  X -Z  plane. 

Figures  4.5  - 4.9  are  computer-generated  plots  showing 

contours  of  constant  joint  angles.  The  outlines  in  the 

contour  plots  indicate  the  extent  of  the  effective 

k k 

workspace  in  the  X — Z plane.  The  joint  values  from  a 
rectangular  data  array  are  used  for  these  plots,  producing 
rough  edges  for  the  reachable  area.  If  enough  data  points 
were  employed,  these  edges  would  actually  be  piecewise 
smooth  circular  arcs.  For  this  reason,  the  joint  angle 
values  at  the  edges  of  the  reachable  area  in  each  figure 
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Figure  4.4  Reachable  workspace  of  the  industrial  robot  with  the 
hand  orientation  held  as  S^=(l  0 0)T  and  a_^y=(0  1 0) 
in  the  X -Z  plane 
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are  slightly  unreliable,  although  the  interior  values  and 
the  important  trends  are  accurately  presented. 

As  mentioned  before,  the  hand  orientation  is  held 
constant  as  S.  »(  1 0 0)T  and  £67=(0  1 0)T  for  these  plots. 
The  joint  angles  are  generated  by  using  the  algorithms 
developed  in  Appendix  B.  For  the  orientation  of  the  hand 
held  in  X*  direction,  there  are  two  feasible  configurations 

"ft  ^ 

for  the  hand  locations  in  the  X -Z  plane.  For  example,  if 
we  specified  the  manipulator's  hand  location  as  the  vector 
(60  0 6 0 ) T inches  and  the  end  effector  orientation  as  S^  = 

(1  0 0)T  and  a6?=(0  1 0)T,  two  sets  of  the  feasible  joint 
angles  are  given  as 


Joint 

Configuration  A 

Configuration  B 

1 

0.000  (Deg.) 

0.000  (Deg . 

2 

88.213 

88.213 

3 

-15.102 

-15. 102 

4 

4.720 

175.280 

5 

160.668 

-160.668 

6 

94.720 

-94.720 

The  joint  angles  of  the  first  joint  are  zero  degree 

* * 

for  the  end  effector  in  this  orientation  and  the  X -Z 
plane.  Configuration  A is  arbitrarily  chosen  for  the 
following  analysis. 
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Figure  4.5  Joint  angles  of  joint 


-160 
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a) . Configuration 
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Figure  4.8  Joint  angles  of  joint 
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a) . Configuration  A b) • Configuration 
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4 . 4 Analysis  of  Actuator  Torques  Due  to  Static  Loads 

The  first  level  dynamic  analysis  of  a manipulator 
structure  involves  the  determination  of  the  actuator 
torques  for  each  joint.  The  actuator  torques  are  required 
to  balance  loads  on  the  system  and  maintain  the  prescribed 
motion  specifications.  In  general,  there  are  four  compo- 
nent loads  to  be  considered  at  each  joint  n: 

1) .  the  effective  load  due  to  static  loads,  F^; 

2) .  the  actuator  load  due  to  inertial  loads,  F^; 

3) .  the  equivalent  load  due  to  other  system  components 

s 

such  as  system  springs  and  dampers,  F^; 

A 

4) .  the  driving  torque  supplied  by  the  actuator,  F^. 

The  first  two  of  these  terms  are  covered  in  detail  in 
Sections  3.4.1  and  3.4.2.  The  third  term  can  be  modeled  by 
using  similar  formulations  in  Reference  [48].  The  actuator 
is  a complex  function  of  the  actuator  and  control  system 
properties.  From  the  design  point  of  view,  these  terms  can 
be  related  as  in  the  following  equation 

FA  = FL  + F1  + FS  (4.1) 

n n n n 

The  actuator  inertial  torque  will  be  analyzed  in  the  next 
section  of  this  chapter.  This  section  contains  the 
analysis  of  the  actuator  torques  resulting  from  several 
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static  loading  conditions.  The  static  loads  investigated 
include  gravity  forces,  the  weight  of  the  arm,  and  applied 
forces  at  the  hand.  In  order  to  obtain  a clear  picture  of 
the  effects  of  general  static  loads,  four  basic  loading 
cases  are  considered  in  this  section: 

★ 

1) .  150  lb  applied  force  at  the  hand  in  the  X 

direction. 

•k 

2) .  150  lb  applied  force  at  the  hand  in  the  Y 

direction. 

* 

3) .  150  lb  applied  force  at  the  hand  in  the  Z 

direction. 

4) .  Gravity  loads  on  all  links  with  no  applied  forces. 


Figure  4.10  - 4.20  show  the  contours  of  constant 
actuator  static  torque  for  each  joint  of  the  industrial 
robot.  From  the  geometry  of  this  robot,  some  equations  of 
the  actuator  torque  can  be  simplified  and  the  results  can 
be  checked  easily.  The  static  actuator  torques  for  each 
joint  are  discussed  individually  in  the  following  pages. 

Since  the  industrial  robot  is  mounted  with  the  axis  of 

•If 

first  joint  vertically  upward  in  Z direction.  Equation 
(3.38)  can  be  reduced  to: 


^HYH  + + m 


HaH  t —6  7 


(4.2) 
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where  F^  is  the  resultant  torque  on  joint  one  due  to  a 

torque  applied  to  the  last  link  and  a force  acting  on  the 

* * * 

hand  reference  point  (X^,  Y^,  Z^) . The  x,  y,  and  z 

superscripts  refer  to  components  of  the  applied  loads.  This 

equation  shows  that  the  actuator  torque  of  the  first  joint 

is  not  affected  by  Z direction  force  and  gravity  loads. 
k k k k 

Also,  Y =0  in  X -Z  plane,  X direction  forces  make  no 
h. 

contribution  to  the  actuator  torque  at  the  first  joint. 

k k 

The  actuator  torque  is  proportional  to  the  X^  for  the  Y 
direction  force  which  is  clearly  shown  in  Figure  4.12. 

For  the  second  joint,  Equation  (3.38)  can  also  be 
simplified  as 

F2  ' <ZH  - 32>£iS  - XHfH  - "67  <4’3) 

Equation  (4.3)  shows  that  there  is  no  effect  on  the 

L * 

actuator  torque  F£  due  to  the  force  in  Y direction,  the 

k k 

torque  in  the  X direction  and  the  Y direction.  Figures 

4.10  and  4.15  present  the  simple  contours  of  constant 

L 

actuator  torque  F^. 

Figure  4.18  shows  the  large  magnitude  of  the  gravity 
loads.  The  magnitude  of  the  actuator  torque  at  joint  2 
increases  rapidly  to  a maximum  of  about  100,000  in-lb  as 

k 

the  hand  moves  outward  from  the  Z axis  (see  Figure  4.21). 
This  is  because  the  moment  arms  for  the  gravity  loads 
increase  as  the  centroids  of  the  links  move  out  from  the 


axis  . 
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The  actuator  torque  results  for  joint  3 are  harder  to 
visualize  than  the  joint  2 results  discussed  above.  This 
is  partly  due  to  the  fact  that  the  joint  axis  moves  around 
the  S2  axis  with  a radius  a23  as  the  position  of  the  hand 

k 

changes.  In  the  X -Z  plane,  the  j32  axis  always  passes 

through  the  point  (0  0 32)  inches.  There  is  no  such  fixed 

point  for  the  axis.  The  direction  cosines  of  are  (0 

T * 

-1  0)  , hence,  forces  in  the  Y direction  produce  no 

actuator  torques. 

Since  the  axis  is  parallel  to  and  moves  around 
S2  on  a circular  arc  about  Z =72  inches  (s^  + a23  = 76 
inches),  the  X*  direction  forces  may  intersect  the  joint  3 
axis  for  hand  positions  in  which  is  about  Z =72  inches. 

The  effects  can  be  clearly  seen  from  Figures  4.11  and  4.22. 
The  magnitude  of  the  joint  torque  is  maximum  in  the  top  and 
bottom  sections  of  the  reachable  space.  These  are  the 
regions  where  the  offset  link  is  vertical,  giving  the 

largest  moment  arms  about  axis  for  X direction  forces 

as  shown  in  Figure  4.23. 

Offset  link  is  nearly  horizontal  for  hand  posi- 

tions about  Z*=72  inches  (see  Figure  4.24).  While  this 
leads  to  the  maximum  magnitude  of  the  joint  torques  due  to 

•k 

gravity  forces  and  applied  forces  in  the  Z direction. 
Figures  4.16  and  4.19  show  the  contours  of  joint  torques  at 
joint  2.  The  actuator  torque  results  for  the  case  of  the 
applied  force  in  the  Z*  direction  are  similar  in  nature  to 
the  gravity  load  results. 
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It  was  mentioned  previously  that  the  geometry  of  the 

industrial  robot  is  a special  case  of  the  general  6R 

manipulator  geometry  in  that  several  joint  axes  intersect 

or  are  parallel,  allowing  a tractable  position  analysis. 

Since  the  axes  of  and  are  parallel  and  the  axes  of 

S,  S and  S,  are  intersected  at  a point,  this  produces 
—4  ’ —5  —o 

some  decoupling  between  the  effects  of  the  hand  reference 

point  location  and  the  hand  orientation. 

Because  of  the  geometry  of  the  industrial  robot,  the 

k k 

fourth  joint  axis,  , always  lies  in  the  X — Z plane.  For 
this  reason,  the  joint  axis  intersects  the  line  of 

k k 

action  of  the  applied  force  in  the  X or  Z direction.  The 
actuator  torque  F^  is  therefore  zero  in  these  cases. 

Figure  4.13  shows  the  torque  at  actuator  4.  The 
actuator  torques  at  joint  4 due  to  the  applied  force  in  the 
Y direction  depend  mainly  on  the  angle  between  the  axes  of 
and  S ^ . The  joint  torque  function  can  be  simply 
expressed  as 

■ fH  S66  S1"  e <4'4) 

for  this  industrial  robot.  The  actuator  torque  F^  increase 
from  zero  when  the  0 is  zero  degree,  as  shown  in  Figure 
4.23,  to  a maximum  magnitude  that  would  reach  900  in. -lb. 
if  the  magnitude  of  the  0 could  be  increased  to  90  degrees 
(see  Figure  4.23). 
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Figure  4.10  Static  torques  at  joint  2 due  to  Figure  4.11  Static  torques  at  joint  3 due  to 

a 150  lb  force  in  the  X direction  a 150  lb  force  in  the  X direction 


132 
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Figure  4.12  Static  torques  at  joint^.1  due  to  Figure  4.13  Static  torques  at  joint  ^4  due  to 

a 150  lb  force  in  the  Y direction  a 150  lb  force  in  the  Y direction 
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Figure  4.14  Static  torques  at  joi^t  5 due  to 
150  lb  force  in  the  Y direction 
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Figure  4.17  Static  torques  at  joint  5 due  to 
150  lb  force  in  the  Z direction 
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Figure  A. 18  Static  torques  at  joint  2 due  to  Figure  4.19  Static  torques  at  joint  3 due  to 

gravity  loads  gravity  loads 
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Figure  4.20  Static  torques  at  joint  5 due  to  gravity  loads 
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03 


Figure  4.23  Configurations  of  the  maximum  joints torque  of 
joint  3 for  the  applied  forces  in  X directio 
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Figures  4.14,  4.17  and  4.20  present  the  actuator 
torques  on  joint  5 for  the  loading  cases.  Due  to  the  last 
two  twist  angles,  the  joint  axis  does  not  lie  in  the 
X -Z  plane  except  the  joint  angles  of  joint  4,  <P^,  are  0, 
+180.  This  effects  can  be  clearly  seen  from  these  figures. 
For  the  joint  angle  cf>5=+180  as  shown  in  Figure  4.8,  the 

ic  "k  & 

joint  axis,  j>,.  lies  in  the  X -Y  plane  of  about  Z =72 

* 

inches  and  intersects  the  applied  forces  in  the  Y direc- 
tion.  The  applied  forces  in  the  X direction  intersect  the 
fifth  joint  axis  S^5 , so  no  actuator  torque  is  produced. 

Since  the  point  of  force  application  H and  the  cen- 
troid of  link  67  both  lie  on  the  final  joint  axis  j>6 » the 
lines  of  application  of  all  applied  loads  and  of  the 
gravity  load  on  the  final  link  pass  through  this  joint  axis 
producing  no  resultant  torque  about  the  joint.  The 
actuator  torque  of  joint  6 is  therefore  zero  for  all  of  the 
static  loading  cases  considered. 

4 . 5 Analysis  of  Actuator  Torques  Due  to  Inertia 

The  first  step  toward  the  analysis  of  the  actuator 
torques  for  each  joint  is  the  determination  of  the  actuator 
torques  resulting  from  static  loads  in  a range  of  hand 
locations  which  has  been  discussed  in  detail  in  Section 
4.4.  This  section  employs  similar  techniques  to  those  used 
in  the  previous  sections  to  analyze  the  relationships 
between  the  actuator  torques  and  the  arm  motions  of  the 
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manipulators.  A specified  motion  of  the  hand  is  using  for 
investigating  the  actuator  torques  and  joint  motions  of  the 
industrial  robot. 

It  is  generally  more  convenient  and  useful  for 
designer  to  deal  with  the  velocity  and  acceleration  of  the 
hand  rather  than  of  the  joints  themselves.  Therefore,  the 
model  formulations  of  velocity  and  acceleration  referenced 
to  the  hand  motion,  as  developed  in  Sections  3.3.3  and 
3.3.4,  are  preferred  for  the  analysis  in  this  section.  From 
Equations  (3.19),  (3.31),  (3.32)  and  (3.45),  the  inertia 
torque  at  joint  n can  be  rewritten  as 

■ llH|n;  + — H Ipn]  (4'5) 

where  the  hand-referenced  inertia  modeling  matrices  [I  ] 

H 

and  [P  ] are  defined  as 
n 

[IH]  = [I*]  [J]_1 

[p"i  - [Ji'hip*]  - i uH]  Knur1  (4.7) 

m=  1 ’ 

where  -T  superscript  indicates  the  transpose  of  the  inverse 
of  the  matrix  and  [ ] , m=  1 , 2,  ...,6,  are 


K) 

* Kl- 

Ihr] 

^HN(N+1) ^ 

l-H1 

33 

II 

[ H5  ] 
H 

= tHN(N+l)^ 

(4.8) 

[**«] 

= [hsi. 

I«h1 

^hn(n+i)1 
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Equation  (4.5)  shows  that  the  inertia  torques  at  the 
actuators  depend  on  both  the  velocity  and  acceleration  of 
the  hand.  The  inertia  torques  F*,  n=l,  2,  ...,  N,  are 

usually  largest  during  the  acceleration  and  deceleration 
parts  of  the  motion.  These  torques  are  also  very 
significant  during  the  high  velocity  operations.  This  can 
be  seen  from  Equation  (4.5).  The  velocity-related  inertia 
torques  are  proportional  to  the  velocity  squared,  so 
doubling  the  speed  multiplies  this  torque  term  by  four. 

A simple  hand  motion  is  employed  to  see  the  dynamic 

properties  of  the  industrial  robot.  Assuming  zero  hand 

acceleration,  the  inertia  torques  at  actuator  n due  to  a 

* 

hand  velocity  of  magnitude  60  in/sec  in  the  X direction 

* * 

are  determined  for  a range  hand  locations  in  the  X -Z 
plane.  Figures  4.26  - 4.29  show  the  resultant  inertia 
torques  for  each  joint  of  the  example  manipulator.  The 
second  joint  has  experienced  large  inertia  torques  for  the 
prescribed  hand  motion.  The  corresponding  joint  velocities 
and  accelerations  at  these  joint  is  shown  in  Figures  4.30  - 
4.37. 

Although  only  a simple  motion  considered  at  the  hand, 
these  plots  show  that  the  actuator  inertia  torque  is  the 
most  difficult  torque  to  conceptualize  of  those  analyzed  in 
this  study.  One  reason  the  joint  inertia  torque  is  hard  to 
visualize,  the  velocity-related  torque  term  is  not  a simple 
linear  terra,  and  the  formulation  for  [P^]  is  an  extremely 
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complex  function.  Some  of  the  results  are  discussed  in  the 
f ollowing . 

The  joint  velocities  about  the  axis  of  joint  2 remains 
nearly  constant  throughout  this  range  of  hand  positions 
(Figure  4.30).  The  joint  speed  are  high  at  the  right  and 
left  edges  of  the  working  range,  this  is  because  that  the 
joint  3 is  at  its  joint  rotational  limits  (see  Figure  4.6). 
This  is  also  why  joint  3 has  the  large  inertia  torques  at 
these  regions.  From  Figures  4.26  and  4.34,  the  joint 
acceleration  contours  correspond  very  closely  to  the 
actuator  torques.  These  figures  also  show  that  the  inertia 
torque  and  joint  acceleration  are  greatest  along  the 
outside  boundary  of  the  working  volume  and  in  the  reachable 
points  nearest  to  the  axis  of  joint  2. 

Figures  4.31  and  4.35  indicate  that  the  joint 
velocities  and  accelerations  at  joint  3 tend  to  increase  as 

«|p 

the  hand  extends  outward  from  the  Z axis.  Conversely,  the 

joint  velocity  is  minimum  in  the  upper  left  section  of  the 

working  area  because  S^,  is  nearly  vertical.  The  joint 

k 

acceleration  is  minimum  in  the  lower  left  corner  for  Z 
about  35  inches.  The  joint  inertia  torques  of  joint  3 are 
very  complex  and  hard  to  visualize  the  results,  since  this 
joint  has  the  high  joint  speeds  and  the  velocity-related 
torque  term  is  the  dominant  term  of  the  joint  inertia 
torque  for  the  specified  hand  motion. 


in/sec 
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Figure  4.26  Inertia  torques  at  joint  2 due  to  a Figure  4.27  Inertia  torques  at  joint  3 due  to  a 
hand  velocity  of  magnitude  60  in/sec  hand  velocity  of  magnitude  60  in/sec 


0]  in/sec 
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Figure  4.28  Inertia  torques  at  joint  4 due  to  a Figure  4.29  Inertia  torques  at  joint  5 due  to  a 

hand  velocity  of  magnitude  60  in/sec  hand  velocity  of  magnitude  60  in/sec 


0]  in/ sec 
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Figure  4.36  Joint  accelerations  at  joint  4 due  to  Figure  4.37  Joint  accelerations  at  joint  5 due  to 
a hand  velocity  of  magnitude  60  in/sec  a hand  velocity  of  magnitude  60  in/sec 
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For  the  industrial  robot,  the  last  few  joints  gener- 
ally provide  orientation  of  the  hand.  In  this  analysis  the 
orientation  of  the  hand  is  constant  and  the  hand  velocity 
is  constant,  the  joint  velocities  of  the  last  three  joints 
remain  in  the  low  speeds  which  are  clearly  shown  in  Figures 
4.32  - 4.33.  The  joint  acceleration  contours  in  Figures 
4.36  and  4.37  correspond  very  closely  to  joint  inertia 
torques  in  Figures  4.28  and  4.29,  respectively. 

4.6  Analysis  of  the  Manipulator  Hand  Deflections 

Another  important  consideration  for  manipulator  design 
and  control  is  the  relative  magnitude  of  the  system  de- 
formations under  load.  For  precision  control  of  a manipu- 
lator, a complete  dynamic  model  can  be  used  to  predict  and 
therefore  compensate  for  the  deformations.  In  manipulator 
design,  the  primary  concern  is  to  reduce  the  structural 
deformations  and  increase  the  rigidity  of  the  arm.  The 
objective  of  the  section  is  to  analyze  how  the  hand  de- 
formation characteristics  vary  with  the  position  in  the 
effective  workspace. 

A lumped  mass  model  of  deformatins  for  serial  robotic 
manipulators  has  been  developed  in  Section  3.4.3  where  the 
compliance  at  each  joint  represents  the  actuator  flexibili- 
ty and  the  lumped  masses  include  the  actuator  and  link 
masses.  This  approximation  greatly  simplifies  the  compu- 
tational procedure  but  should  be  used  only  when  these  joint 
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deflections  are  the  dominant  deformation  terms.  The  de- 
flection, ARh»  at  the  hand  of  a manipulator  due  to  an 
applied  load,  F at  the  end  effector  can  be  rewritten  as 

ARh  = [J] [c  ] [J]T  Fh  (4.9) 

The  basic  assumption  for  this  equation  is  that  the  de- 
formations in  manipulators  are  relatively  small.  The  de- 
formations due  to  the  gravity  loads  in  the  arm  are  neglect- 
ed. Knowing  the  loads  acting  and  the  joint  stiffnesses  (or 
compliances),  three  components  of  translational  deflection 
and  three  components  of  rotational  deflection  at  the  hand 
can  be  determined. 

Because  of  the  physical  significance  and  convenience, 
the  quadratic  norm  (P^=2)  is  useful  for  characterizing  the 
hand  deflection  magnitude  as 

I!  RrII  2 = (lHtJ^C(()][J]TtWR][Jl[C(i,1[J]T-H)1/2  (4>10) 

where  [WD]  is  a diagonal  matrix  of  weighting  factors. 

For  simplicity,  the  weighting  matrix  is  taken  as  an 
identity  matrix  in  the  analysis. 

A number  of  loading  conditions  are  considered  in  this 
section  in  order  to  get  a complete  picture  of  the  effects 


of  the  applied  load. 
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1) .  150  lb  applied  force  at  the  hand  in  the  X 

direction. 

k 

2) .  150  lb  applied  force  at  the  hand  in  the  Y 

direction. 

k 

3) .  150  lb  applied  force  at  the  hand  in  the  Z 

direction. 

4)  . 100  in-lb  moment  applied  to  the  last  link  in  the 

* 

X direction. 

5) .  100  in-lb  moment  applied  to  the  last  link  in  the 

k 

Y direction. 

6) .  100  in-lb  moment  applied  to  the  last  link  in  the 

k 

Z direction . 

Figures  4.38  - 4.49  present  the  contours  of  the  trans- 
lational and  orientational  hand  deflections  due  to  each  of 
the  loading  conditions  described  above  with  a set  of  joint 
stiffness  as 

Joint  Joint  stiffness 

1 lxlO7  (in-lb/rad) 

2 7xl06 

3 5x 1 06 

4 lxlO5 

5 7xl04 

6 7xl04 


Joint  Stiffnesses  K,  — [1000  700  500  10  77]  x 10  in  lb/rad 
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Figure  4.40  Magnitude  of  the  translational  hand  Figure  4.41  Magnitude  of  the  rotational  hand  de- 
deflection due  to  a 150  lb  force  in  flection  due  to  a 150  lb  force  in  the 

>C 

the  X direction  direction 


Joint  Stiffnesses  K,  = [1000  700  500  10  7 7]  x 10  in-lb/rad 
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Figure  4.42  Magnitudes  of  the  translational  hand  Figure  4.43  Magnitudes  of  the  rotational  hand 

deflection  due  to  a 150  lb  force  in  deflection  due  to  a 150  lb  force  in 

the  Z*  direction  t^ie  ^ direction 


Joint  Stiffness  K,  = [1000  700  500  10  7 7]  x 10  in-lb/rad 
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Figure  4.44  Magnitudes  of  the  translational  hand  Figure  4.45  Magnitudes  of  the  rotational  hand 

deflection  due  to  a 100  in-lb  moment  deflection  due  to  a 100  in-lb  moment 

in  the  X*  direction  in  the  X direction 


Joint  Stiffnesses  K,  = [1000  700  500  10  7 7 ] x 10  in-lb/rad 
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Figure  4.46  Magnitudes  of  the  translational  hand  Figure  4.47  Magnitudes  of  the  rotational  hand 

deflection  due  to  a 100  in-lb  moment  deflection  due  to  a 100  in-lb  moment 

in  the  Y*  direction  i-n  ^ direction 


Joint  Stiffnesses  K,  = [1000  700  500  10  77]  x 10  in  lb/rad 
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Figure  4.48  Magnitudes  of  the  translational  hand  Figure  4.49  Magnitudes  of  the  rotational  hand 

deflection  due  to  a 100  in-lb  moment  deflection  due  to  a 100  in-lb  moment 

in  the  Z*  direction  in  the  Z direction 
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Figure  4.50  Weak 
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Figures  4.42  and  4.43  show  that  there  are  very  large  hand 

•k 

deflections  due  to  the  applied  load  in  the  Z direction. 

For  the  hand  positions  around  the  coordinates  (92  0 60) 

inches,  the  hand  deflections  can  be  as  much  as  .34  inch  in 

magnitude  of  the  translational  hand  deflection  and  .83 

degree  in  magnitude  of  the  orientational  hand  deflection 

which  are  about  60  times  of  the  required  accuracy,  .005 

inch,  for  assembly.  Figure  4.50  shows  these  large 

deflections  are  caused  by  the  large  moment  arms  of  the 

k 

joints,  2,  3 and  5,  for  the  applied  load  in  the  Z 

direction,  since  the  joint  axes  and  JI3  are  perpendicular 

to  the  X -Z  plane  and  the  axis  is  lied  in  the  X -Y 

plane  for  Z about  60  inches. 

4 . 7 Analysis  of  the  Natural  Frequencies  of  Manipulators 

As  manipulator's  operational  speed  increase,  vibration 
considerations  begin  to  play  an  important  role  in  the  de- 
sign of  the  manipulator  and  its  control  systems.  Vibrations 
in  the  small  are  due  to  transient  phenomena  acting  on  the 
system.  This  study  in  manipulator  vibrations  deals  prin- 
cipally with  determining  the  natural  frequencies,  ( n= 1 , 

2,...,  N)  . The  fundamental  natural  frequency  gives  one  of 
the  best  overall  indicators  of  the  system’s  structural 
integrity  and  the  maximum  speed  for  performing  precise  arm 


motions . 
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A lumped-mass  arm  model  has  been  developed  in  Section 
3.4.4  for  evaluating  the  natural  frequencies  of  serial 
manipulators.  Equation  (3.63)  shows  those  frequencies 
which  can  be  determined  from  a standard  eigenvalue  problem, 
and  can  be  rewritten  in  the  following  form. 

|a)2[I*]  - [ ] |=0  (4.11) 

Expanding  the  above  characteristic  determinant  we 

2 

obtain  an  algebric  polynominal  of  Nth  order  in  U)  which  is 
known  as  the  characteristic  equation  or  frequency  equation. 
Its  roots  are  the  desired  eigenvalues.  Since  the  joint 
stiffnesses  in  [ ] are  large  numbers,  it  is  not  a proper 
computational  approach  to  obtain  the  eigenvalues  by  using  a 
root  solving  procedure. 

If  [I*]  and  [K^]  are  symmetric  and  positive  definite, 
the  eigenvalues  are  real  and  positive  [77] . There  are 
various  numerical  schemes  for  obtaining  these  eigenvalues 
of  an  eigenvalue  problem  involving  the  symmetric  and 
positive  definite  matrices.  The  QR  algorithm  [78]  is  used 
here  to  determine  the  natural  frequencies  and  the 
corresponding  eigenvectors. 

Figures  4.51  - 4.54  show  that  the  distributions  of  the 
first  four  natural  frequencies  of  the  industrial  robot  with 

a set  of  joint  stiffnesses  K =[1000  700  500  10  7 7]  xlO 

“<P 

in— lb/rad  for  the  X — Z plane  of  hand  locations. 


As  in  the 
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previous  sections,  the  hand  of  the  robot  is  in  a single 

orientation  defined  by  j5g=(l  0 0)  > _5.67  = (®  ^ ^)  for  the 

range  of  hand  positions.  From  Figure  4.51,  the  fundamental 
natural  frequency  is  the  lowest  along  the  outside  boundary 
of  the  working  volume  because  in  this  region  where  the  arm 
is  fully  extended  and  S2  has  the  greatest  moment  of 
inertia.  The  lowest  fundamental  frequency  is  about  6 Hz  at 
the  outside  boundary.  Since  the  stiffness  of  joint  2 is 
the  dominant  spring  constant  for  the  first  mode  (see  the 
following  eigenvectors),  which  implies  the  industrial  robot 
to  have  structural  weakness  near  the  shoulder  for  the 
system.  The  operational  frequencies  of  the  arm,  w,  should 
be  kept  significantly  lower  than  the  lowest  natural 
frequency  (W<<6  Hz)  in  order  to  prevent  dynamic  coupling 
between  the  vibrations  and  gross  motion  deformations. 

Figure  4.52  show  that  the  second  natural  frequency  has 
low  frequencies  about  9 Hz  along  the  lower  right  workspace 
boundary  and  high  frequencies  about  25  Hz  in  the  upper 
section  of  the  reachable  area.  From  the  analysis  of  the 
vibrational  modes,  the  eigenvectors  indicate  the  frequen- 
cies in  the  right  and  lower  area  are  dominated  by  the  first 
joint  stiffness.  When  the  end  effector  moves  to  the  left 
and  upper  section,  the  dominant  spring  constant  is  switched 
to  the  joint  3.  The  reason  is  that  the  moment  arm  about 
the  axis  is  large  in  the  lower  right  section  and  small 

in  the  upper  left  section  of  the  working  area. 


This  effect 
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can  be  clearly  seen  from  the  following  examples.  The 
natural  frequiencies  and  eigenvectors  for  hand  locations  at 
point  A,  B and  C in  Figure  4.52  are  found  as  follows: 

1).  Hand  location  at  point  A,  (48  0 60)  inches 
Natural  frequencies  (Hz) 


8.58 

16.36 

24.28 

41.96 

61.19 

126.40 

Corresponding 

natural 

modes  (column  vectors) 

0.00 

0.00 

1.00 

0.00 

0.00 

0.00 

1.00 

-0.23 

0.00 

0.00 

0.00 

0.00 

0.32 

1.00 

0.00 

0.00 

0.01 

0.00 

0.00 

0.00 

-0.46 

1 . 00 

-0.25 

-0.09 

-0.20 

-0.55 

-0.13 

0.34 

1 . 00 

-0. 12 

0.00 

-0.01 

-0.02 

0.17 

0.09 

1.00 

Hand  location  at  point  B,  (64 
Natural  frequencies  (Hz) 

.8  0 60) 

i nches 

7.77 

17.81 

17.82 

41.90 

6 1.17 

126.32 

Corresponding 

natural 

modes  (column  vectors) 

0.00 

1.00 

-0.27 

0.00 

0.00 

0.00 

1 . 00 

-0.13 

-0.27 

0.00 

0.00 

0.00 

0.38 

0.49 

1 . 00 

0.00 

0.01 

0.00 

0.00 

-0.27 

0.07 

1.00 

-0.25 

-0.09 

-0.21 

-0.36 

-0.55 

0.34 

1 . 00 

-0.12 

0.00 

-0.01 

0.00 

0.17 

0.09 

1 . 00 
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3).  Hand  location  at  point  C,  (72  0 60)  inches 


Natural  frequencies  (Hz) 


7.43 

14.97 

18.75 

41.93 

61.19 

126.44 

Corresponding 

natural 

modes 

(column  ' 

vectors) 

0.00 

1.00 

0.00 

0.00 

0.00 

0.00 

1 . 00 

0.00 

-0.29 

0.00 

0.00 

0.00 

0.40 

0.00 

1 . 00 

0.00 

0.01 

0.00 

0.00 

-0.18 

0.00 

1 . 00 

-0.25 

-0.09 

-0.21 

-0.05 

-0.60 

0.34 

1 . 00 

-0.12 

0.00 

0.00 

-0.01 

0.17 

0.09 

1 . 00 

The  results  explicitly  show  that  there  are  two  equal 
natural  frequencies  near  the  location  of  point  B and  two 
vibrational  modes  are  changed  at  that  point.  Figures  4.55 
- 4.57  show  the  arm  configurations  at  these  points. 
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CHAPTER  5 


OPTIMIZING  ACTUATOR  PARAMETER  DISTRIBUTIONS 
FOR  ROBOTIC  MANIPULATORS  BASED  ON  LOCAL  DYNAMIC  CRITERIA 

5 . 1 Introduction 

The  analysis  methods  described  in  Chapter  4 give  the 
actuator  loads,  hand  deflections  and  natural  frequencies 
for  a given  position  with  a prescribed  applied  load,  ve- 
locity and  acceleration  state  of  the  arm.  These  results  of 
such  analysis  may  be  used  to  choose  actuators  of  the  ap- 
propriate size  for  any  specified  motion.  The  information 
may  also  be  used  to  indicate  the  problems  for  redesign  of 
mechanical  structures.  But  this  information  is  of  only 
limited  use  to  the  designer  because  there  is  such  a pro- 
fusion of  possible  states  to  consider.  In  this  chapter  the 
optimization  techniques  are  employed  for  condensing  the 
information  about  actuator  parameters  by  imposing  motion 
magnitude  constraints  at  the  hand. 

The  preceding  chapter  presented  an  extensive  analysis 
of  the  industrial  robot  for  a variety  of  applied  loads  and 
motions.  Computer  generated  plots  are  used  to  display 
these  analysis  information  in  a compact,  understandable 
form  and  explicitly  show  how  system  parameters  vary  as  a 
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function  of  hand  positions,  applied  loads  and  motions.  In 
order  to  establish  a first  level  of  understanding  and 
computational  methodology,  the  work  in  the  rest  of  this 
chapter  will  consider  local  properties,  i.e.,  properties  at 
a specified  position  or  configuration  of  the  device.  A 
more  complete  methodology  would  result  by  considering  a 
range  of  configurations  in  the  available  workspace  of  the 
system.  The  global  evaluation  can  only  be  established  by 
including  the  functional  dependence  of  the  position  vector 
as  a variable  in  the  optimization  formulation.  This  leads 
to  the  application  of  nonlinear  optimization  techniques  to 
develop  general  design  tools  for  manipulators  based  on 
global  dynamic  criteria.  This  global  optimization  work 
will  be  presented  in  the  next  chapter. 

The  industrial  robot  described  in  Chapter  4 is  also 
employed  for  analysis  of  the  results  of  local  dynamic 
criteria  in  this  chapter.  The  configurations  investigated 

"k  k 

consist  of  an  X — Z plane  of  locations  of  the  hand  refer- 

* 

ence  point  H with  the  hand  pointing  outward  from  the  Z 

T 

axis  in  a single  orientation  defined  by  S^=(l  0 0)  and 
a67=(0  1 0 ) T . 

5 . 2 Maximum  Actuator  Torques  Due  to  Generic  External 
Loads 


Since  manipulators  are  usually  designed  for  a wide 


spectrum  of  applications,  they  must  be  capable  of 
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supporting  a variety  of  applied  loads.  Hence,  the 
fundamental  question  of  this  section  can  be  stated  as 
follows:  Given  a configuration  of  the  manipulator,  what  is 

the  worst  joint  load  for  each  actuator  with  specified 
magnitude  of  a applied  load  on  the  end  effector. 

The  actuator  torques  Fn  are  generally  considered  to  be 
independent  design  parameters  such  that  each  should  be 
considered  separately.  The  static  torque  F^  at  joint  n due 
to  the  applied  load  Ffl  at  point  H on  the  end  effector  is 
given  from  Equation  (3.39)  as 


F 

n 


Ih 


- [£„*<»  - £„>  1 • IH  + £n  • 2n(n+n  (5'1) 

From  this  equation,  we  know  that  F^  is  a function  of  arm 
configuration  and  external  loads.  In  this  section  the 
directions  of  the  applied  loads  are  left  arbitrary,  the 
maximum  magnitude  of  load  on  joint  n for  a specific  config- 
uration is 


* 'in*'"  - + (">K  N+l  > > max  <5'2> 

where  (fH)max  and  (mN(N+i))max  are  the  maximum  magnitudes 
of  the  applied  force  and  torque  at  the  hand,  respectively, 
and  | Snx(H-  R ) | is  the  perpendicular  distance  between  the 
hand  position  and  the  joint  axis  S_ . Figure  5.1  shows  the 
worst  external  loads  for  joint  2 of  the  industrial  robot. 
The  remainder  of  this  section  displays  and  discusses  the 
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Figure  5.1  The  worst  applied  loads  for  joint 
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results  of  the  maximum  actuator  torques  due  to  a force  of 

magnitude  150  lb  and  a torque  of  magnitude  2000  in-lb  on 

* * 

the  hand  for  a range  of  hand  positions  in  the  X -Z  plane. 

Since  the  axis  of  joint  1 is  fixed  and  directed  verti- 
cally, the  worst  applied  force  and  torque  are  parallel  to 

^ A 

Y axis  and  Z axis,  respectively.  The  perpendicular 

* 2 

distance  from  the  first  joint  axis  to  the  point  H is  ((X^) 

+( Y* ) 2 ) 1 ^ 2 and,  since  Y*  = 0 for  the  plane  of  hand  positions 
H H 

* 

considered,  the  maximum  joint  torque  is  proportional  to  V 

This  is  readily  seen  in  Figure  5.2. 

Figure  5.3  shows  the  maximum  joint  torques  for  joint  2 

due  to  the  generic  loads.  Because  the  joint  torque  is 

proportional  to  the  perpendicular  distance  from  the  axis  of 

joint  2 to  the  point  of  load  application,  the  lines  of 

constant  maximum  torque  are  circular  arcs  about  the  point 

* * 

(0  0 32)  inches  where  joint  axis  intersects  the  X -Z 

plane.  The  directions  of  the  worst  applied  force  are 

tangent  to  the  contour  curves. 

The  maximum  static  torques  on  actuator  3 are  plotted 

in  Figure  5.4.  Since  the  position  of  the  third  joint  axis 

changes  as  the  hand  position  varies,  the  maximum  joint 

torques  depend  on  the  distance  between  the  hand  and  the 

joint  axis.  Figure  5.4  shows  the  maximum  contour  values 
£ 

are  around  Z =72  inches  where  the  offset  links  and  Sgg 

are  nearly  parallel  and  the  distance  is  maximum.  This 
configuration  is  shown  in  Figure  4.24. 
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As  mentioned  previously,  the  fourth  joint  axis  lies  in 
the  X -Z  plane,  the  X and  Z components  of  force  have  no 
effect  on  the  actuator  torque  F^.  The  maximum  joint 
torques  on  actuator  4 can  be  simply  expressed  as 

(F^)  = (fu)  S,,  Sin  9+  (mA7)  (5.3) 

4'max  H max  66  67  max 

where  6 is  the  angle  between  the  axes  and  as  shown  in 
Figure  4.25.  It  is  interesting  to  note  that  the  worst 
cases  for  joint  4 are  in  the  top  and  bottom  sections  of  the 
effective  workspace  as  shown  in  Figure  5.5.  Conversely, 
Figure  5.4  shows  that  these  are  the  best  configurations  for 
supporting  external  loads  at  joint  3. 

Since  the  geometry  of  the  industrial  robot,  the  twist 
angle  between  and  is  61°  and  the  distance  between 
and  the  hand  reference  point  H is  fixed,  the  maximum  static 
torque  at  joint  5 is  simplified  as 


(F^)  = ( f __ ) S,.  sin  a,,  + (mA7)  (5.4) 

v 5'max  v H/max  66  56  67  max 

For  (f„)  =150  lb  and  (ra,.,)  =2000  in-lb,  the  maximum 

H max  67  max 

static  torque  at  joint  5 is  a constant  value,  2787.158 

k k 

in-lb,  for  all  hand  positions  in  X -Z  plane. 

In  a similar  manner,  the  maximum  torque  at  actuator  6 
is  also  a fixed  value,  2000  in-lb,  for  the  reachable  posi- 
tions, since  the  applied  forces  pass  through  joint  axis  • 
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5 . 3 Maximum  Actuator  Torques  Due  to  Generic  Hand  Velocity 

The  actuators  of  a manipulator  must  also  be  designed 
to  provide  sufficient  driving  torque  to  overcome  the  iner- 
tia forces  induced  by  the  prescribed  magnitudes  of  the  end 
effector  velocity  and  acceleration  . This  section 
derives  analysis  methods  to  further  condense  the  inertia 
torque  results  by  prescribing  the  motion  capabilities  which 
are  independent  of  direction.  Instead  of  determining  the 
actuator  torques  due  to  the  hand  motions  in  given  di- 
rections as  done  in  Section  4.5,  the  directions  are  left 
arbitrary  and  the  maximum  magnitudes  of  velocity  and  accel- 
eration are  chosen  to  find  the  maximum  actuator  inertia 
torque  at  each  joint  for  a specific  configuration.  This 
assures  that  if  the  magnitudes  of  the  arm  velocity  and 
acceleration  are  less  than  these  specified  values,  none  of 
the  joint  inertia  torque  are  exceeded. 

The  inertia  loads  at  the  actuators  depend  on  both  the 

velocity  and  acceleration.  For  simplicity,  the  first  case 

to  be  considered  in  this  section  requires  that  the  hand 

acceleration  equal  to  zero  (A  =0).  In  order  to  obtain  the 

maximum  joint  inertia  torques  (F^)  for  a prescribed  hand 

J n max 

speed,  regardless  of  the  direction  of  the  velocity  vector 

Va , this  problem  can  be  stated  as 
— H 
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For  a given  configuration  of  the  manipulator 
maximize  the  magnitude  of  actuator  torque  F^ 
for  each  joint  subject  to  the  constraint 

v„  - I »H|2  < (VH)aax. 


The  velocity-related  inertia  torque  F^  at  actuator  n is 
given  from  Equation  (4.5)  as 

K - [p“]  Vh  (Ah-0)  (5.5) 


The  hand  velocity  can  be  decomposed  into  magnitude  and 

unit  direction  vector  e as 

—v 


— H 


e 

— v 


and 


T 
— v 


[W2  ] 
1 v 


(5.6) 


(5.7) 


where  [ W^.  ] is  a 6x6  diagonal  matrix  of  weighting  factors. 
Using  Equations  (5.6)  and  (5.7),  the  inertia  torque  F^  at 
actuator  n becomes 


n 


[PH]  e 
n —v 

[ W2  ] e 
1 v — v 


o r 


[ W2  ] ^P11]  e 

L v n —v 


(5.8) 


(5.9) 


The  right-hand  side  of  Equation  (5.9)  is  in  the  form  of  the 
Rayleigh  quotient  [50]  which  results  in  the  solution 
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n;min 


n max 


(5.10) 


where  Xn  are  the  eigenvalues  of  the  symmetric  matrix 


(l/2)[wj]  ^[P®]  + [P^]T] 


(5.11) 


Therefore,  the  inertia  torque  F1  at  actuator  n for  an  end 

n 

effector  velocity  of  magnitude  is  in  the  range 


n max 


(5.12) 


This  result  can  be  used  to  evaluate  the  maximum  or  mimimum 
value  of  actuator  inertia  torque  for  a specified  magnitude 
of  velocity,  or  to  find  the  maximum  velocity  for  prescribed 
joint  torque  limits.  The  latter  case  has  been  analyzed  in 
detail  in  [6].  For  the  former  case,  the  maximum  magnitude 
of  inertia  torque  at  actuator  n is  given  as 


Figures  5.6  - 5.10  show  the  maximum  inertia  torques 

for  each  joint  due  to  the  translational  hand  velocity  of 

magnitude  (v  ) =59  in/sec  of  the  industrial  robot  for  a 

11  max 

range  of  hand  positions.  The  velocity-related  inertia 
torque  is  the  most  difficult  torque  term  to  conceptualize 
of  those  considered  in  this  study.  Notice  that  the 


n max 
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to  translational  hand  velocity  to  translational  hand  velocity 

( v ) =60  in/sec  =60  in/sec 


zzi  -J3ET 
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Figure  5.10  Maximum  inertia  torques  at  joint  5 
due  to  translational  hand  velocity 
(v  ) =60  in/sec 
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Figure  5.11  Configuration  of  the  largest  maximum  Figure  5.12  Configuration  of  the  smallest  max 

inertia  torque  at  the  first  three  joints  inertia  torque  of  joint  1 for  the 

for  the  translational  hand  velocity  translational  hand  velocity 
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Figure  5.13  Configuration  of  the  smallest  maximum  Figure  5.14  Configuration  of  the  largest  maximum 
inertia  torque  of  joint  1 for  the  inertia  torque  of  joint  1 for  the 

translational  hand  velocity  translational  hand  velocity 
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Figure  5.15  Configuration  of  the  smallest  maximum  Figure  5.16  Configuration  of  the  largest  max 
inertia  torque  of  joints  2 and  3 for  inertia  torque  of  joints  2 and  3 

the  translational  hand  velocity  the  translational  hand  velocity 
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smallest  values  of  the  maximum  inertia  torque  occur  near 
the  middle  of  the  effective  workspace.  This  is  good 
because  this  is  where  many  of  the  robot's  tasks  are 
performed . 

Figure  5.6  shows  the  maximum  inertia  torques  at  the 
first  joint  due  to  the  translational  hand  velocity.  Posi- 
tions A and  D are  the  worst  positions  for  the  inertia  load 
at  this  joint,  since  joint  1 sees  large  moments  of  inertia 
and  has  high  joint  velocity  at  these  positions  (see  Figures 
5.11  and  5.14).  Positions  B and  C in  Figure  5.6  are  the 
positions  where  the  inertia  are  well  balanced  for  joint  1. 
Figures  5.12  and  5.13  plot  the  configurations  of  the 
industrial  robot  at  these  positions. 

Figures  5.7  and  5.8  show  that  joints  2 and  3 have 
quite  similar  contours  of  the  inertia  torque  distribution 
in  the  reachable  workspace.  Figures  5.15  and  5.16  present 
the  configurations  of  the  industrial  manipulator  at  the 
positions  E and  F in  Figures  5.7  and  5.8.  Note  that  joint 
2 has  the  largest  inertia  throughout  almost  the  entire 
working  range. 

5 . 4 Maximum  Actuator  Torques  Due  to  Generic  Hand 
Acceleration 

In  a similar  manner  to  that  used  in  Section  5.3, 

assuming  zero  hand  velocity  (y_jj  = 0),  the  maximum  magnitude 

of  inertia  torque  (F1)  at  actuator  n due  to  the  maximum 

n max 

acceleration  (A.,)  in  a given  position  <f>  can  be  found  by 

Umax  — 
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Maximizing  the  actuator  torque  subject  to 

2 2 2 

the  condition  AR  = |AH  ||2  < (AH)max. 


The  Lagrangian  can  be  expressed  as 


" Fn  + ,5  “ (AH)max) 


(5.14) 


where  .5X  is  the  Lagrangian  multiplier.  The  necessary 
conditions  for  the  maximum  F^  give 


= [IH]T  + X[W2]  A 

= (-i/X)  [w2]_1[iV. 

d n , 

-H  [Wa^  -H  " ^ AH ^ max 

^ — H = <Vmax 


(5.15) 


(5.16) 


The  scalar  X can  be  determined  by  substituting  Equation 
(5.15)  into  Equation  (5.16),  to  get 


1 

X 


^ AH  ^ max 


( [ !H ] . [W^]  1 [IH]^.)1/2 
n ; a n ; 


(5.17) 


Substituting  this  result  into  Equation  (5.15),  the  maximum 
hand  acceleration  (Ajj)max 


can  be  found  as 
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<Ah> 


max 


(Vmax  UHi;; 

([IH]n;  [W2]-l 


1/2 


(5.18) 


Then,  the  maximum  inertia  load  (F^)  at  actuator  n due  to 

7 Ll  111  d A 

the  acceleration  of  the  hand  can  be  determined  as 


(Fn5max  [I  1 n;  ^H^ax 

= (A  ) ( [ IH ] [W^]_1[IH]^.)1/2  (5.19) 

H max  n;  a n; 

Figures  5.17  - 5.21  present  the  maximum  inertia  torque 
results  due  to  the  translational  hand  acceleration  of 

O 

magnitude  100  in/sec  for  the  industrial  robot.  In  order 
to  have  a better  understanding  of  the  results.  Figure  5.22 
displays  the  inertia  matrix  [I  ] for  several  hand  posi- 
tions. The  inertia  torques  necessary  for  accelerating  the 
hand  in  the  fixed  coordinate  system  are  given  as 

F1  = [IH]  Ar  (Vr=0)  (5.20) 

Figure  5.17  indicates  that  the  worst  areas  of  inertia 
load  for  joint  1 are  in  the  top  and  bottom  sections  of  the 
working  space.  The  inertia  matrices  displayed  in  Figure 
5.22  also  confirm  this  effect.  As  an  example  of  the  po- 
sition D,  consider  the  value  169  in  the  first  row  (first 
joint),  second  column  (Y*  direction).  This  indicates  that 
joint  1 must  exert  a torque  of  169  in-lb  to  accelerate  the 
hand  1 in/sec  in  Y direction. 


In  the  region  about  the 
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point  B,  the  inertia  torque  of  the  arm  at  joint  1 attains 

its  lowest  values.  As  expected  from  the  geometry  of  the 

* 

industrial  robot,  accelerating  the  hand  in  the  Y direction 
requires  more  torque  at  joint  1 than  accelerations  in  the 
other  two  directions.  This  can  be  clearly  seen  from  the 
first  three  elements  of  first  row  of  the  inertia  matrices 
[IH]  in  Figure  5.22. 

The  lowest  values  of  the  effective  inertia  torque 
about  joint  axis  occur  near  the  middle  of  the  work- 
space. The  inertia  torques  about  joint  2 tend  to  increase 
inward  and  outward  from  this  region,  because  the  inertia 
torques  increase  as  the  hand  moves  in  those  directions.  The 

U 

inertia  matrices  [I  ] of  positions  E,  F and  G in  Figure 
5.22  show  the  second  joint  has  minimum  effective  inertia  at 
position  F . 

The  maximum  inertia  torque  about  the  axis  of  joint  3 
remains  nearly  constant  throughout  this  range  of  hand 
positions.  The  largest  values  of  the  inertia  are  along  the 
outside  boundary  of  the  working  volume. 

For  the  industrial  robot,  the  last  three  joints  gener- 
ally provide  orienting  of  the  hand.  Therefore,  the  values 
of  the  maximum  inertia  torque  for  joints  4 and  5 due  to  the 
translational  hand  acceleration  are  low.  The  inertia 
torque  at  joint  6 has  no  effect  due  to  the  translational 
hand  acceleration.  This  is  because  the  mass  centroid  of 
the  final  link  lies  along  the  S,  axis,  such  that 
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Figure  5.17  Maximum  inertia  loads  at  joint  1 due  Figure  5.18  Maximum  inertia  loads  at  joint  2 due 
to  hand  acceleration  of  the  magnitude  to  hand  acceleration  of  the  magnitude 

(a  ) =100  in/sec2  (a  ) =100  in/sec2 
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Figure  5.19  Maximum  inertia  loads  at  joint  3 due  Figure  5.20  Maximum  inertia  loads  at  joint  4 due 

to  hand  acceleration  of  the  magnitude  to  hand  acceleration  of  the  magnitude 

(a  ) =100  in/sec^  (a  ) =100  in/sec^ 


Units 
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CM 


Figure  5.21  Maximum  inertia  loads  at  joint  5 due  to  hand 

acceleration  of  the  magnitude  (a  ) =100  in/sec 
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Figure  5.22  Effective  inertia  [IH]  for  several  hand  positions 
in  the  reachable  workspace 
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accelerations  of  this  centroid  produce  no  moment  about  this 
axis.  The  first  three  components  of  sixth  row  of  the  [I  ] 
matrices  in  Figure  5.22  are  zero,  also  indicating  that 
there  is  no  effective  inertia  at  joint  6 for  translational 
motions. 

5 . 5 Optimizing  Actuator  Compliance  Distribution  for 
A Known  Load 


The  compliance  and  deformation  of  a serial  manipulator 
are  distributed  throughout  its  structure  during  operations. 
Increased  compliance  in  one  part  of  the  chain  can  be 
compensated  by  increasing  stiffness  in  another  component. 
Consequently,  optimization  techniques  are  useful  for 
rationally  obtaining  the  best  structural  stiffness  distri- 
bution. The  modeling  matrices  of  actuator  stiffness  and 
compliance  in  Section  3.4.3  form  a convenient  basis  for 
understanding  and  computation  for  applying  these  design 
techniques  . 

The  deflection,  AR„ , at  the  end  effector  of  a manipu- 

H 

lator  due  to  an  applied  load,  F_^ , at  the  hand  can  be 
explicitly  written  as  a linear  combination  of  the  individ- 
ual joint  compliances 


AiH  = £ 


(5.21) 


T 

„ , „ r r.l  is  the  vector  of  joint 

where  C^=[Ci>  c2»  " ' > °NJ 


compliances  (diagonal  elements  of  [C  ,]).  The  component  in 


165 


row  m and  column  n of  the  position  and  force  dependent 
matrix  [ JF ] is 


[JF1  = [J]  ( [ J ] F„) 

L Jm;n  1 Jm;n  1 J;n— 


(5.22) 


where  fJl  is  the  element  of  the  Jacobian  [J]  in  row  m 

L m ; n 

and  column  n,  and  [J].n  represents  column  n of  the 
Jacobian . 

Now  it  is  possible  to  synthesize  the  individual  joint 
compliances  C^.  The  manipulator  must  satisfy  a set  of  per- 
formance criteria  which  could  be  represented  by  limits  on 
the  magnitude  of  the  hand  deflection.  However,  there  are 
real  costs  associated  with  decreasing  the  joint  compli- 
ances, such  as  the  need  for  larger  actuators  (more  weight), 
increased  gear  reduction  (more  friction  and  backlash),  more 
expensive  matrials  and  components,  etc.  Therefore,  a 
balanced  design  formulation  can  be  of  the  form: 


For  a given  manipulator  configuration  maximize 
the  compliance  magnitude  II  C II  subject  to  the 

— tp  p 

hand  deflection  constraint  ||  ARgf  £ ^ax’ 

where  AR  is  the  magnitude  of  the  maximum 
max 

allowable  deflection  at  the  end  effector. 


Because  of  its  physical  significance  and  convenience,  the 
quadratic  norm  (P  =2)  is  useful  for  the  hand  deflection. 


Squaring  this  norm,  the  deflection  constraint  is  represent- 
ed as  a quadratic  function  of  the  component  compliances: 


„ II ? = cT  [A]  C,  < AR2 
■H  "2  — <J>  — <j>  — m 


max 


(5.23) 


where 


[A($,  Fh,  Wr)]  = [JF]T  [W2]  [JF] 


(5.24) 


Here  [ ] is  a 6x6  diagonal  matrix  of  weighting  factors  W_r 

that  represent  the  relative  significance  of  the  different 
components  of  the  hand  deflection  to  a given  operation. 

The  deflection  is  formulated  in  terms  of  compliances 
rather  than  stiffnesses  because  flexibilities  in  a serial 
structure  are  a linear  combination  (see  Equation  (5.21)). 
However,  maximizing  the  p-norm  of  joint  flexibilities  with 
constraints  on  the  total  deflection  produces  an  undesirable 
solution  - the  resulting  distribution  often  contains  comp- 
liances which  are  zero.  A simple  two  degrees  of  freedom 
manipulator  in  Figure  5.23  illustrates  this  effect.  Table 
5.1  lists  the  corresponding  kinematic  data,  the  applied 
force  and  the  weighting  matrices.  Figure  5.24  shows  that 
this  result  is  physically  impossible  since  no  actuator  can 
be  infinitely  stiff.  This  situation  can  be  remedied  by 
bounding  the  component  stiffness,  in  which  case  the  associ- 
ated stiffness  will  be  at  their  upper  limit  in  the  optimal 
distribution  (see  Figure  5.25). 
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Figure  5.23  A two  degree  of  freedom  manipulator 


Table  5.2  The  kinematic  parameters,  applied  load  and  weighting 
matrices  of  a system  with  two  flexible  joints 


a).  Kinematic  parameters  and  joint  angles 


Joint  a..  a.,  S..  Joint  angles 

3 k jk  33 

No.  (deg)  (in)  (in) (deg) 

1 0 20  0 0 

2 15  0 90 


b)  . Maximum  allowable  deflection  at  hand 

AR  = 0.001  in 
max 

c)  . Applied  load 

Fu  = [100  0 0 0 0 0]T  lb 


d) . Weighting  matrices 


[WA]  - X 

tv  - 1 


2x2 

6x6 


1x10 
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Figure  5.24  Maximizing  joint  flexibilities  subject  Figure  5.25  Maximizing  joint  flexibilities  subject 
to  hand  deflection  constraints  to  hand  deflection  constraints  and 
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An  alternate  approach  is  to  minimize  a p-norm  of  the 
flexibilities  with  pc<0  which  corresponds  to  the  minimi- 
zation of  the  norm  of  the  component  stiffness.  In  this 
case,  the  optimal  distribution  will  never  contain  compo- 
nents which  are  infinitely  stiff.  For  example,  minimizing 
a linear  combination  (pc=_l)  °f  the  stiffnesses  subject  to 
the  quadratic  constraint  (p^=2)  on  the  hand  deflection 
leads  to  a nonlinear  set  of  equations  which  must  be 
satisfied  by  the  optimal  compliance  distribution.  A 
nonlinear  optimization  technique  or  graphical  procedure 
could  be  used  to  solve  these  equations.  Another  useful 

formulation  is  the  p = -“  form  which  minimizes  the  maximum 

c 

stiffness  (or  maximize  the  smallest  compliance).  The 
problem  can  be  formulated  as 

For  a given  manipulator  configuration  maximize 
the  smallest  (weighted)  compliance  subject 

to  the  constraint 

“h  ■ ! ABh  >2  ■ [“r2'  fi-H  < “max 

for  a known  load  F^^ . 

Often,  the  optimal  solution  for  this  problem  will 
occur  when  the  weighted  values  of  all  component  flexibili- 
ties are  equal  (see  Figure  5.26).  The  magnitude  of  the 
component  stiffnesses  are  determined  by  the  constraint  on 
the  deflection  ||AR  . 


170 


This  solution  is  optimal  if  3 1|  AR  ||  0 / 3 C >0  for  all 

— ri  z n — 

components  Cn*  However,  if  one  or  more  of  the  derivatives 

3 II  2/3Cm  are  negative,  then  the  stiffness  can  be  further 

decreased  by  replacing  the  constraint  W C =W  C with 
J r ° m m n n 

3 II  Ar  ||  _ / 3 C =0.  This  means  that  for  all  component  compli- 
ances  which  are  not  equal  to  smallest  weighted  flexibility, 
the  gradient  of  ||  Ar  [|  ^ (considered  as  a function  of  C^) 
must  be  normal  to  these  component  axes.  This  formulation 
for  the  optimal  compliance  distribution  (pc  = -<»,  pr  = 2)  is 
equivalent  to  the  general  quadratic  programming  problem 
with  linear  inequality  constraints.  The  solution  procedure 
mentioned  above  involves  a slight  modification  of  the 
simplex  algorithm  for  linear  programming  [20].  Figure  5.27 
illustrates  this  alternate  situation  for  a simple  system 
composed  of  two  compliant  components. 

Other  formulations  for  compliance  distribution  lead  to 
the  same  type  of  problem  and  similar  solution  procedures 
(i.e.,  pc=-l,  pr=l).  In  addition  for  this  implied  compara- 
tive review  of  these  various  formulations,  a major  issue  to 
be  addressed  is  the  selection  of  the  values  for  weighting 
factors.  These  weighting  factors  must  be  determined  by 
physical  design  considerations  of  the  system.  For  example, 
W should  be  greater  than  W £ to  reflect  the  fact  that 
increasing  the  stiffness  of  the  distal  actuators  (i.e.,  by 
using  larger  prime  movers)  is  more  costly  in  terms  of 


1x10  ' 1x10 
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Figure  5.26  Optimal  distribution  has  equal  (weighted)  Figure  5.27  Optimal  distribution  of  joint  compliance 
component  compliances  has  9 ||  AR  ||  2/3C^=0 
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dynamic  performance  (larger  inertia  loads)  than  increasing 
the  stiffness  for  the  actuators  at  the  base  of  the  arm. 

The  optimal  actuator  compliance  distribution  of  the 
example  industrial  robot  for  a known  load  on  the  hand  is 
determined  in  the  following  analysis.  A 150  lb  force  in 
the  X*  direction  is  applied  to  the  hand  reference  point  and 
the  maximum  allowable  magnitude  of  the  hand  deflection  is 
0.005  inches.  The  values  pc  = -°°  and  pr  = 2 are  selected  here 
in  terms  of  a quadratic  programming  algorithm  for  solving 
for  the  compliance  distribution. 

Figures  5.28  - 5.33  show  the  optimal  compliance  dis- 
tributions of  all  actuators  for  a plane  of  hand  positions 
in  the  manipulator's  reachable  space.  The  contours  of 
constant  value  show  the  minimum  joint  stiffnesses  such  that 
the  prescribed  precision  is  attained.  Figures  5.28  - 5.30 
indicate  that  large  stiffness  values  are  required  for 
joints  2 and  3 when  the  hand  is  in  the  top  or  bottom 
sections  of  the  effective  workspace.  This  is  because  the 
moment  arms  for  the  applied  load  increase  as  the  hand  moves 
further  away  from  the  horizontal  planes  containing  the  axes 
and  . Figure  5.29  shows  that  the  magnitude  of  the 

•k 

stiffness  is  minimum  in  the  area  near  the  Z =32  inches, 
since  the  joint  2 is  constrained  to  pass  through  the  point 
with  coordinates  (0  0 32)  inches.  As  mentioned  above,  link 

k 

S ^ is  nearly  horizontal  for  hand  positions  in  which  is 
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igure  5.28  Stiffness  of  joint  1 with  150  lb  force  Figure  5.29  Stiffness  of  joint  2 with  150  lb  force 
in  Xx  direction  and  the  maximum  magnitude  in  X'v  direction  and  the  maximum  magni- 

of  the  hand  deflection  .005  in.  tude  of  the  hand  deflection  .005  in. 


xlO  in-lb/rad 
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Figure  5.30  Stiffnesg  of  joint  3 with  150  lb  force  Figure  5.31  Stiffnes^  of  joint  4 with  150  lb  force 
in  the  X*  direction  and  the  maximum  in  the  X direction  and  the  maximum 

magnitude  of  the  hand  deflection  0.005  magnitude  of  the  hand  deflection  0.005 
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Figure  5.32  Stiffness  of  joint  5 with  150  lb  force  Figure  5.33  Stiffness  of  joint  6 with  150  lh  force 
in  the  X*  direction  and  the  maximum  in  the  X direction  and  the  maximum 

magnitude  of  the  hand  deflection  0.005  magnitude  of  the  hand  deflection  0.005 
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about  72  inches.  This  leads  to  minimum  required  stiffness 

* 

for  joint  3 due  to  applied  forces  in  the  X direction. 


5 . 6 Optimizing  Actuator  Compliance  Distribution 
for  Generic  Loads 


Since  manipulators  are  designed  for  flexibility  of 
applications,  they  must  be  capable  of  supporting  a variety 
of  applied  loads  while  maintaining  positional  accuracy. 
Hence,  the  stiffness  design  task  might  best  be  formulated 
as 

For  a given  manipulator  configuration  find  the 
optimal  compliance  distribution  such  that 
the  norm  of  the  deflection  AR^  produced  by  any 
applied  load  of  magnitude  less  than  (Fn^max 
will  be  less  than  AR 

max 

(F  ) is  the  largest  magnitude  of  external  load  that  can 

H'max 

be  applied  to  the  end  effector  in  all  directions.  General- 
ly, the  quadratic  norm  (p^=2)  is  desirable  for  the  load 
magnitude  since  there  is  no  directional  preference  associ- 
ated with  this  norm.  Using  pf  = 2 for  the  deflection  magni- 
tude also  leads  to  a complex  set  of  nonlinear  equations  for 
the  optimal  compliance  distribution.  These  equations  can 
again  be  solved  by  numerical  techniques.  Alternatively, 


the  value  00  or  1 could  be  used  for  pr 


to  reduce  the 


177 


solution  complexity.  Here,  Pr=l  is  selected  since  it 
produces  more  conservative  results  (see  Figure  2.2). 

Optimizing  the  compliance  with  Pc  = -°°  as  in  the  previ- 
ous section,  the  stiffness  distribution  problem  can  be 
stated  as 

For  a given  manipulator  configuration  minimize 
(maximize)  the  maximum  stiffness  (smallest  com- 
pliance) component  1/W^C^  (or  W^C^)  subject  to 
the  deflection  constraint 

I Arh|  1 . a1  [Wr]  Arh  < ARmax 
for  all  applied  loads  F_^  satisfying 

S Hh* I ‘ la  tw|]  fh  < (FH)^ax. 


Here,  [Wr]  and  [Wf]  are  diagonal  matrices  of  weighting 
factors  for  components  of  AR„  and  F„.  Each  component  (0.=1 

— rl  — n J 

or  aj=-l)  of  a is  chosen  such  that  a^AR^M).  Assuming  o_  is 

known,  the  deflection  magnitude  is  a bilinear  function  of 

F„  and  C,  of  the  form 
— H — (p 


AR 


■H" 


1 = Fh  [JR]  C 


<P 


(5.25) 


where  the  component  in  row  i and  column  j of  [JR]  is  given 
by 


CJEI  i;  J ' | °k  "r*  [Jh;j 


(5.26) 
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The  Lagrangian  for  the  constrained  optimization  problem  can 
be  formulated  as 


L - II  ii^ll  _oo  + K 1 II  II 1 K 2 II  — H I!  2 (5.27) 

where  K 1 and  are  LaSratlge  multipliers.  The  optimality 
condition  on  _F^  is 

3L  3 II A R 1 2 

= 0 = Kj — - + 2k2  [Wj]  Fr  (5.28) 


Substituting  Equation  (5.25)  into  Equation  (5.28)  leads  to 
the  result  that  is  a linear  function  of 

IH  = Y [ ] ~ 1 [JR]  (5.29) 

where  Y = -K^/2i<2  is  an  unknown  scalar  multiplier.  The  value 
for  Y can  be  found  by  substituting  Equation  (5.29)  into  the 
load  constraint  yielding 

(FH^max  = -H  [Wf^  -H 

= Y2  [ JR ] T [W^]-1  [JR]  (5.30) 

Similarly,  the  constraint  on  the  deflection,  Equation 
(5.25)  , becomes 

||Ar  I = ycj  [JR]T  [ W J ] “ 1 [JR]  C,  < AR 
— H 11 1 — (p  fJ  —<p  — max 


(5.31) 
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Squaring  this  equation  and  dividing  by  Equation  (5.30) 
leads  to  the  quadratic  compliance  constraint  equation  as 

cl  [B]  C,  < (AR2  / ( F„ ) 2 ) (5.32) 

— <f>  1 J — <j>  — v max  v H'max 

where 

[B]  = [JR]T  [W2]-1  [JR]  (5.33) 

As  the  Equations  (5.23)  and  (5.24)  in  the  previous  section, 
this  formulation  leads  to  a quadratic  programming  problem. 
The  same  solution  procedure  can  be  employed,  but  with  the 
additional  constraint  that  0_.AR^>J3  for  all  deflection 
components.  The  stiffness  distribution  problem  can  be 
rewritten  as 

For  a given  manipulator  configuration  maximize 
the  smallest  compliance  component  subject 

to  the  quadratic  compliance  constraint 

d [B]  C,  < (AR2  /(F„)2  ). 

— <f>  1 J — <p  — max  H'max 

Each  component  (J  of  0 in  matrix  [B]  must  be  chosen  such 
that  a ARj>0. 

As  mentioned  before,  the  selection  of  the  appropriate 
p-norms  for  the  vector  quantities  leads  to  a quadratic 
programming  problem  as  described  in  Section  5.5.  The  same 
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solution  procedure  can  be  employed  to  obtain  the  joint 
compliances  necessary  to  keep  the  hand  deflection  less  than 
0.005  inches  for  applied  loads  up  to  150  lb  in  magnitude. 
Figure  5.34  shows  the  contours  of  the  optimal  compliance 
magnitude  II  C^|]  _<jo  for  a range  of  hand  positions  in  X -Z 
plane  for  the  selected  robot.  The  maximum  compliance 
magnitude  II  C^l  is  smallest  along  the  outside  boundary  of 
the  working  volume.  Conversely,  the  magnitude  in  the 
reachable  point  nearest  the  axis  of  joint  2 is  greatest. 
This  is  to  be  expected  since  the  moment  arm  for  the  generic 
loads  increases  as  the  arm  stretches  out  which  requires 
that  the  joints  be  stiffer  to  maintain  the  desired 
positioning  accuracy. 

5 . 7 Natural  Frequencies  Analysis  Based  on  the  Local 
Optimal  Actuator  Stiffness  Distribution 

Using  the  lumped-mass  model  found  above  in  Sections 
3.4.4  and  4.7,  the  vibration  frequencies  of  manipulator 
systems  can  be  obtained  and  predicted  since  the  industrial 
robots  do  not  generally  have  long  flexible  links  such  as 
those  found  in  the  shuttle  manipulator.  An  example  has 
been  solved  for  the  natural  frequencies  of  the  example 
industrial  robot  with  a set  of  joint  stiffnesses  in  Section 
4.7.  The  lowest  fundamental  natural  frequency  there  is 
about  6 Hz  for  a range  of  hand  positions  in  the  X -z 


plane . 
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In  this  section  the  same  analysis  procedure  is 
employed  to  obtain  the  natural  frequencies  of  the  optimal 
distribution  of  actuator  stiffness  which  presented  in  the 
previous  section  for  the  industrial  manipulator.  The  joint 
stiffnesses  necessary  to  keep  the  end  effector  deflection 
less  than  0.005  inches  for  applied  forces  up  to  150  lb  in 
magnitude  are  K^=[6.4  6.4  4.48  1.92  1.28  .64]xl0  in- lb/ 
rad  . 

Figures  5.35  and  5.36  show  that  the  distributions  of 

the  first  two  natural  frequencies  of  the  industrial  robot 

* * 

with  the  improved  stiffness  distribution  for  the  X -Z 
plane  of  hand  locations.  Applying  the  optimal  stiffness 
distribution  criteria  to  the  industrial  robot  significantly 
improves  the  precision  and  increases  the  lowest  natural 
frequency  of  the  system.  This  improved  distribution  of 
joint  stiffness  increases  the  fundamental  natural  frequency 
by  a factor  about  ten. 
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Figure  5.35  First  natural  frequency  distribution  Figure  5.36  Second  natural  frequency  distribution 

of  the  industrial  robot  with  the  joint  of  the  industrial  robot  with  the  joint 

stiffnesses  K,=f6.40  6.40  4.48  1.92  stiffnesses  K.=[6.40  6.40  4.48  1.92 

1.28  0. 64]T  x10«  in-lb/rad  1-28  0.64 l1  x 10b  in-lb/rad 


CHAPTER  6 


OPTIMIZATION  OF  ACTUATOR  PARAMETER  DISTRIBUTIONS 
FOR  DESIGN  OF  ROBOTIC  MANIPULATOR 

6 . 1 Introduction 

The  previous  chapter  has  developed  design  criteria  and 
computational  design  tools  for  optimizing  the  distribution 
of  actuator  parameters  for  a given  manipulator  configura- 
tion. The  computational  methods  and  the  local  optimization 
criteria  based  on  the  rigid  link,  flexible  joint  model 
prove  useful  for  design  because  they  condense  the  informa- 
tion about  actuator  parameters  by  imposing  motion  and  load 
magnitude  constraints  at  the  end  effector  for  a given  con- 
figuration. Computer  generated  plots  for  compactly  dis 
playing  extensive  dynamic  analysis  results  and  computer 
graphics  for  illustrating  robot  motion  have  been  employed 
to  help  designers  select  rational  design  specifications. 

The  optimization  schemes  also  expand  the  designer's  under- 
standing of  the  geometric  and  dynamic  aspects  of  systems. 

The  model  formulation  directly  indicates  the  position 
dependent  nature  of  the  results  augumented  by  the  contour 
plots  which  show  how  system  strength  and  stiffness  charac- 
teristics vary  a$  a function  of  hand  position  and  arm 
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configuration.  These  local  design  criteria  in  Chapter  5 
are  only  of  limited  use  to  the  designer,  since  there  are  so 
many  configurations  of  a minipulator  in  its  workspace  to 
consider.  Therefore,  the  localized  techniques  are  extended 
to  develop  global  design  criteria  for  general  robotic 
manipulators  in  this  chapter.  These  global  evaluations  can 
be  established  by  including  the  position  vector  ^ as  a 
variable  in  the  optimization  formulations.  Since  these 
formulations  are  position  dependent  and  nonlinear,  general 
nonlinear  optimization  algorithms  are  required  to  find  the 
"worst-case"  hand  positions  and  arm  configurations.  These 
global  design  procedures  make  it  possible  to  satisfy  load, 
dynamic  state  and  precision  requirements  in  the  workspace 
and  provide  faster  operation  by  increasing  the  frequencies 
of  the  fundamental  vibration  modes.  It  is  believed  that 
the  design  criteria  for  actuator  parameters  represent  a 
significant  step  forward  in  the  state-of-the-art  of  design 
of  robotic  manipulators. 

The  pattern  search  method  of  Powell  and  the  exterior 
penalty  method  presented  in  Chapter  2 are  employed  for  the 
examples  of  this  chapter.  The  Powell's  method  is  a direct, 
sequential  stepping  technique.  This  method  is  quite  effec- 
tive in  solving  optimization  problems.  It  should  be 
cautioned,  however,  that  none  of  the  optimization  methods 
can  discriminate  between  a local  and  a global  minimum. 
Therefore,  it  is  necessary  to  start  the  computational 


186 


process  at  several  initial  estimates  to  determine  the 
global  minimum. 

6 . 2 Distribution  of  Actuator  Sizing  Due  to  Static  Loads 

Actuators  are  the  muscles  of  a manipulator.  They  are 
also  the  primary  source  of  the  system  strength  and  flexi- 
bility constraints.  An  essential  initial  design  step 
involves  how  to  determine  the  actuator  static  load  capacity 
of  each  joint  for  a given  load  handling  capacity  of  the 
device.  The  load  handling  capacity  is  considered  here  to 
be  the  largest  load  which  can  be  applied  to  the  hand  of  a 
robotic  manipulator  in  any  direction.  This  load  capacity 
is  directly  related  to  size  distribution  of  actuators  that 
drive  the  system. 

In  order  to  assure  that  there  is  no  actuator  over-load 
due  to  an  applied  load  with  magnitude  less  than  the  system 
load  handling  capacity  during  operation,  the  maximum  load 
handling  actuator  capacity  of  each  joint  is  the  basic 
specification  we  should  consider.  The  maximum  actuator 
capacities  are  generally  independent  of  each  other  and  each 
of  the  actuators  should  be  investigated  separately. 

For  simplicity,  the  first  case  to  be  considered  re- 
quires that  we  neglect  the  gravity  loads.  The  maximum 
magnitude  of  load  on  joint  n due  to  the  externally  applied 
loads  at  the  hand  for  a configuration  is  derived  in 
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Equation  (5.2).  A formal  statement  for  obtaining  the 
global  maximum  actuator  capacity  can  be  stated  as 

For  an  N degree  of  freedom  manipulator,  find 
the  maximum  actuator  load  capacity  for  each 
joint,  (F^)  , subject  to  the  load  constraints 

II -H  II 2 1 (fH^max  and  H— N ( N+l  ) H 2 - ^ mN  ( N+l  ) ^ max 
and  the  joint  angle  constraints 

^^min  ± ( ^ i } max  ’ 1 = ^ 2»  N* 

Figures  6.1  - 6.4  show  the  contours  of  the  maximum 

static  torques  at  joints  due  to  the  applied  loads, 

=150  lb  and  (m^.,)  =2000  in-lb,  at  the  hand  in  the  work- 

67'max 

space.  The  outermost  contours  indicate  the  workspace  in 
the  X -Z  plane.  These  plots  are  based  on  data  from 
discrete  points,  which  leads  to  the  rough  edges  for  the 
working  area.  The  actual  workspace  of  the  industrial  robot 
has  been  shown  in  Figure  4.3. 

Since  the  industrial  robot  is  fixed  with  the  axis  of 
the  first  joint  pointing  vertically  upward  in  the  direction 
of  the  Z axis  and  the  origin  of  the  second  joint  at  the 
point  (0  0 32)  inches,  the  contour  plots  of  the  maximum 
static  torques  at  these  joints  displayed  in  Figures  6.1  and 
6.2  are  similar  to  Figures  5.2  and  5.3  where  the  last  link 
is  held  as  S^  = (l  0 0)T  and  £67=(0  1 0)T.  Figure  6.1  shows 
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the  first  joint  load  is  not  affected  by  the  Z direction 
loads.  The  contours  of  the  maximum  static  torques  are 
circular  arcs  about  the  origin  of  joint  2,  because  the  axis 

-If 

S2  is  parallel  to  the  Y direction  as  shown  in  Figure  6.2. 

The  shaded  regions  of  Figures  6.3  and  6.4  represent 
the  largest  values  of  the  maximum  static  loads  which  can  be 
reached  when  the  hand  position  is  in  these  areas.  The 
largest  torque  values  are  about  11150  in— lb  and  2900  in-lb 
for  joints  3 and  4,  respectively.  Figures  6.5  and  6.8 
display  the  two  worst  configurations  for  joint  3 at  the 
hand  positions  which  are  not  in  the  shaded  area  of  Figure 
6.3.  Figures  6.6  and  6.7  are  also  the  worst  configurations 
for  joint  3 with  the  same  magnitudes  of  loads  on  the  hand 
which  is  in  the  shaded  region.  Some  of  the  worst  config- 
urations for  joint  4 are  displayed  in  Figures  6.9  - 6.12. 

As  in  Section  5.2,  the  maximum  static  torques  of 
joints  5 and  6 are  constants  for  all  the  positions  in  the 
workspace.  The  maximum  static  torques  due  to  the  external 

loads,  (fH)max=150  lb  and  (m67>max=2000  in_lb’  for  a11  the 
joints  of  the  example  industrial  robot  are  listed  in  Table 

6.1. 

The  following  investigation  of  the  actuator  static 
loads  will  include  the  effects  of  the  gravity  forces  from 
the  weight  of  the  arm  and  the  applied  loads  at  the  hand. 

The  limits  of  the  actuator  loads  for  supporting  the  static 
loads  depend,  in  general,  on  the  position  and  configuration 
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Figure  6.1  Maximum  static  torques  at  joint  1 due  Figure  6.2  Maximum  static  torques  at  joint  2 due  to 

to  (f  ) =150  lb  and  (m,.-,)  =2000  in- lb  (f..)  =150  lb  and  (m  7)  =2000  in- lb  in 
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robot  for  joint  3 due  to  (f  ) =150  lb  robot  for  joint  3 due  to  (f  ) =150  lb 

and  (m,  n)  =2000  in-lb  witn  ¥He  hand  and  (m,-7)  =2000  in-lb  witn  ’tfie  hand 

at  (-l§7Om?^6)  in.  at  (96  0 60^  in. 
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robot  for  joint  3 due  to  (f  ) =150  lb  robot  for  joint  3 due  to  (f  )max=150  lb 

and  (n^^ax312000  with  tfie  hand  and  (m67)max=2000  in-lb  with  the  hand 

at  (30  6 43)  in.  at  (18  0 0)  in. 
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robot  for  joint  4 due  to  (fH)max=150  lb  robot  for  joint  4 due  to  (fH)max=150  lb 

and  (m67)ma  =2000  in-lb  with  the  hand  and  (m67)max=2000  in-lb  with  the  hand 

at  (36  0 72)  in.  at  (66  0 0)  in. 
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Table  6.1  Maximum  actuator  static  torques  due  to 

(f„)  =150  lb  and  (m, 7 ) =2000  in-lb 

v H;max  v 67'max 


Joint 

1 

2 

3 

4 

5 

6 


Maximum  static  torque 
16866  in-lb 
17250 
11150 
2900 
2787 
2000 


(see  Section  4.4)  of  the  manipulator.  The  maximum  actuator 
torque  of  each  joint  due  to  the  static  loads  for  a manipu- 
lator configuration  can  be  obtained  from  Equations  (3.40) 
and  ( 5 . 2 ) as 

<Fi;>max-|Sn  X (H-Rn)  | + («„  ( N + 1 ) > max 

+ (6'l) 

where  f.  is  the  gravity  force  of  link  jk  and  [G.  is  the 

j c J 

nth  component  of  the  first-order  influence  coefficients  for 
the  centroid  of  link  jk. 

The  optimization  problem  of  actuator  static  sizing  can 
be  formulated  as  follows: 
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For  an  N degree  of  freedom  manipulator,  find 


the  maximum  actuator  load  capacity  for  each 


joint  n subject  to  the  gravity  forces,  the 


external  load  constraints 


II  1^2  - ^H^max  and  H — N ( N-+-1 ) H 2 - (mN(N+l))max 


H ' max 


and  the  joint  angle  constraints 


< *1  < <*i> 


i -'max  * 


Consider  the  magnitudes  of  the  applied  loads  at  the 
hand  as  described  in  the  previous  example  and  the  gravity 
loads  at  the  centroids  of  all  links.  Table  6.2  lists  the 
worst  joint  torque  on  each  input  for  the  industrial  robot. 
The  effective  gravity  loads  are  generally  significant  at 
all  joints  except  joint  1 and  6.  For  the  second  joint,  the 
gravity  loads  have  a very  significant  effect  on  this  joint. 
This  is  because  joint  2 sees  the  largest  effective  arm 
massand  must  support  the  full  weight  of  the  arm.  Therefore, 
a manipulator  with  a geometric  configuration  like  that  of 
the  industrial  robot,  joint  2 should  generally  have  the 
largest  load  capacity.  Figures  6.13  ~ 6.17  display  the 
worst  configurations  for  each  joint. 
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Top  view 


Side  view 


Figure  6.17 


Worst 
due  to 
loads 


configuration  of 

(f  ) =150  lb, 

H max 


the  industrial  robot  for  joint  4 

(m,.,)  =2000  in-lb  and  gravity 

6/  max 
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Table  6.2  Maximum  static  torques  due  to  (f,,)  =150  lb 

(m,-,)  =2000  in-lb  and  gravity  Ioats 

v 67 'max 


Joint 


Maximum  static  torque 


1 


16866  in-lb 


2 


113299 


3 


31615 


4 3020 

5 2892 


6 


2000 


6 . 3 Distribution  of  Actuator  Sizing  Due  to  Inertial  Loads 

Sections  5.3  and  5.4  considered  the  maximum  actuator 
torques  due  to  system  inertia  content  with  the  specified 
magnitudes  of  the  hand  velocity  and  acceleration  A^  for 

a specific  configuration.  The  actuator  torques  obtained  in 
this  manner  assure  that  if  the  magnitudes  of  the  arm  veloc- 
ity and  acceleration  are  less  than  these  prescribed  values 
of  the  maximum  hand  velocity  and  acceleration,  none  of  the 
joints  will  be  overloaded,  regardless  of  the  path  direction 
for  the  specific  configuration.  Although  this  represents  a 
significant  step  to  condense  the  dynamic  information  for  a 
manipulator  configuration,  very  many  configurations  must  be 
investigated  to  give  the  designer  comprehensive  knowledge 
of  the  load  and  motion  relationships  for  a specific  arm. 

This  section  employs  the  nonlinear  optimization 
methods  to  develop  the  global  design  criteria  and  further 
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condense  the  dynamic  information  for  general  robotic  ma- 
nipulators. These  design  criteria  will  force  the  actuators 
to  satisfy  the  system  strength  and  dynamic  respons  require- 
ments. They  then  will  be  useful  throughout  the  workspace 
of  the  manipulator  structure.  These  optimization  computa- 
tional methods  are  analogous  to  those  employed  for  finding 
the  actuator  static  load  capacity  in  the  previous  section. 

The  actuator  inertia  torque  can  be  split  into  its 
velocity-related  and  acceleration-related  components  as 
shown  in  Equation  (4.5).  First  consider  the  hand  velocity 
constraints  with  the  hand  acceleration  equal  to  zero. 
Section  5.3  discusses  the  nature  of  the  velocity-related 
inertia  loads  in  detail.  The  velocity-related  torques  are 
generally  very  sigificant  at  all  joints.  This  is  because 
the  velocity-related  inertia  torques  are  proportional  to 
the  hand  velocity  squared.  Therefore  the  torque  component 
rapidly  becomes  important  as  manipulator  speeds  increase. 

Recall  that  the  maximum  magnitude  of  velocity-related 
inertia  torque  at  joint  n with  a specified  hand  speed  for  a 
given  configuration  is  (see  Section  5.3) 


(r) 


n max 


max ( (X 


n max 


) 


(6.2) 


where  (V„) 


H ' max 


is  the  maximum  magnitude  of  hand  velocity  and 


Xn  are  the  eigenvalues  of  the  symmetric  matrix 


d/2)  [W^ ] 1 [ [PH]  + [PH]T] 


(6.3) 
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Therefore,  the  optimization  criterion  for  obtaining  the 
maximum  required  strength  of  inertia  torque  FX  at  each 
joint  regardless  of  the  direction  of  the  hand  velocity  V_^ 
in  the  reachable  workspace  can  be  stated  as 

Maximize  the  magnitude  of  the  inertia  torque 

FX  for  each  joint  subject  to  the  hand 
n 

velocity  constraint 

VH  ■ 1Ih12  ■ <IhI"vIV1/2  < <VH>„ax 

and  the  joint  angle  constraints 

"Mmin  <*1<  <*iW  1 * '■  2’  ••••  N' 

The  velocity-related  inertia  torque  is  the  most  diffi- 
cult actuator  torque  term  to  conceptualize  of  those  consid- 
ered in  this  report.  By  applying  the  criterion  to  the  ex- 
ample industrial  robot,  Table  6.3  lists  the  maximum  inertia 
torque  for  each  joint  due  to  the  translational  hand  veloc- 
ity V =60  in/sec.  Figure  6.19  - 6.24  show  the  worst 
configurations  of  the  inertia  torque  due  to  the  hand  veloc- 
ity VH-  It  is  interesting  to  note  that  the  last  link  of  the 
industrial  robot  is  folded  back  in  these  configurations. 
This  is  because  the  last  link  has  smallest  mass  and  the 
inertia  torque  is  a quadratic  form  of  the  hand  velocity. 
Decreasing  the  distance  between  the  hand  and  the  axis  of 
each  joint,  the  velocity-related  inertia  torque  at  each 
joint  can  be  significantly  increased. 
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Table  6.3  Maximum  inertia  torques  due  to  the 

translational  hand  velocity  Vjj  = 60  in/sec 


Joint 

1 

2 

3 

4 

5 

6 


Maximum  inertia  torque 
3.571xl06  in-lb 
3 . 109xl07 
2.880xl06 
7 . 189xl06 
5 . 968x10"* 

2.636xl03 


Similarly,  for  a specified  acceleration  magnitude  with 
the  hand  velocity  equal  to  zero  are  considered.  The  max- 
imum inertia  torque  at  actuator  n due  to  the  specified 
magnitude  of  hand  acceleration  for  a manipulator  configura- 
tion is  given  by  Equation  (5.19).  Therefore,  the  global 
optimization  problem  of  obtaining  the  necessary  inertia 
torque  for  accelerating  the  hand  in  its  workspace  can  be 
formulated  as 

Maximize  the  magnitude  of  inertia  torque  F ^ 

for  each  joint  subject  to  the  hand 

acceleration  constraint 

T 9 1/2 

A„  - II  Ah12  ‘ * (V».x 

and  the  joint  angle  constraints 

(‘Mmin  < ^i  1 (‘Mmax’  i = 2»  •••»  N‘ 
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Table  6.4  presents  the  maximum  torque  for  each  joint 

2 

due  to  the  translational  hand  acceleration  A^=100  in/sec 
for  the  industrial  robot.  Figure  6.25  - 6.29  display  the 
worst  configurations  of  the  inertia  torque  for  each  joint 
due  to  the  hand  acceleration  and  the  corresponding  inertia 
matrix  [ I11  ] . 

Table  6.4  Maximum  inertia  torques  due  to  the  trans- 
lational hand  acceleration  A^=100  in/sec 

Joint  Maximum  inertia  torque 

1 9.818xl04  in-lb 

2 3.539xl04 

3 5 . 07  4x  1 0 3 

4 1 . 0 14x 103 

5 8 . 8 OOx 1 0 1 

6 0 

Since  the  actuators  of  the  manipulator  must  be 

designed  to  support  applied  loads  and  provide  sufficient 
driving  torque  to  overcome  the  inertia  loads  induced  by  the 
prescribed  end-effector  velocity  and  acceleration  A^ 

during  its  operations.  The  remainder  of  this  section  will 
derive  the  criterion  for  the  maximum  inertia  torque  which 
include  the  velocity-related  term  and  the  acceleration- 
related  term.  This  criteron  for  actuator  sizing  will  be 
developed  for  all  positions  of  the  manipulator.  The  iner- 
tia modeling  matrices  are  position  dependent  terms  (see 
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Figure  6.25  Worst  configuration  of  the  inertia  torque  for  joint  1 due  to  the  translational 
hand  acceleration  A^=100  in/sec^  and  the  corresponding  inertia  matrix  [I**] 
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Figure  6.27  Worst  configuration  of  the  inertia  torque  for  joint  3 due  to  the  translational 
hand  acceleration  A^=100  in/sec^  and  the  corresponding  inertia  matrix  [I  ] 
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(4.6)  and  (4.7))  which  relate  the  motion  states,  VR  and  A R , 

of  the  device  to  the  corresponding  generalized  inertia 

forces  F 1 at  the  actuators.  The  global  evaluation  of  the 
n 

maximum  inertia  torques  can  be  established  by  including  the 
position  vector  as  a variable  in  the  optimization 
formulation . 

The  maximum  inertia  load  (F^;)  at  actuator  n due  to 

n max 

the  hand  velocity  and  acceleration  for  a given  config- 
uration can  be  obtained  from  Equations  (5.13)  and  (5.19)  as 

i 

(F  ) 
v n max 

The  objective  of  this  section  is  to  determine  the 

largest  values  of  (F  ) in  order  to  assure  that  the 

° n max 

actuators  of  the  device  have  the  sufficient  driving  torques 
for  all  positions  and  configurations  in  the  workspace.  The 
optimization  problem  can  be  formulated  as 

Maximize  the  magnitude  of  inertia  torque 
for  each  joint  subject  to  the  hand 
acceleration  constraint 

AH  = ^ 2 = ^ — H ^ W a ^ — H ^ ^ AH  ^ max  ’ 

the  hand  velocity  constraint 

VH  - |VH|2  - <V>v21Vh)1/2  < (VH)max 

and  the  joint  angle  constraints 

^i^min  — — ^i^max’ 


= (VH}max  max((Xn)min’  (Xn)max) 


+ <V»a*  '"al"1 


H T 1/2 
L J n ; ' 


(6.4) 


i 


1 , 2 , . . . , N . 
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6 . 4 Distribution  of  Actuator  Compliance  for  Generic  Loads 

Generally,  it  is  desireable  to  increase  the  operating 
speed  of  the  manipulator.  Precision  of  operation  will  also 
become  increasingly  important  as  development  proceeds.  For 
precision  control  of  a manipulator,  a complete  dynamic  for- 
mulation is  needed  to  predict  and  compensate  for  the  system 
deformations  under  loads.  A formulation  of  force— defor- 
mation relations  to  determine  the  joint  compliance  (or 
stiffness)  has  been  established  in  Section  3.4.3.  Based  on 
this  formulation,  some  local  optimization  criteria  for  dis- 
tribution of  actuator  compliance  are  presented  in  Sections 

5.5  and  5.6.  The  basic  idea  of  these  local  design  criteria 
is  to  determine  a set  of  joint  compliances  which  satisfy 
the  precision  requirements  under  a known  magnitude  of  load 
at  the  hand  with  increasing  magnitude  of  these  compliances. 
Because  there  are  generally  costs  associated  decreasing  the 
joint  compliance. 

In  order  to  design  a system  for  supporting  a variety 
of  applied  loads  and  maintaining  positional  accuracy  at  the 
hand  for  all  configurations  in  the  workspace,  the  stiffness 
design  task  in  Section  5.6  can  be  restated  as 

Find  the  optimal  compliance  distribution 
such  that  the  norm  of  the  deflection  ARjj 
produced  by  any  applied  load  magnitude  less 

than  (FH)max  wil1  be  leSS  than  ARmax‘ 
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Apply  the  local  compliance  criterion  presented  in 
Section  5.6  to  the  example  industrial  robot  for  a range  of 
hand  positions.  Figure  5.34  shows  the  maximum  compliance 
magnitude  II  in  the  X -Z  plane  with  the  hand  orien- 

tation as  16  = (1  0 0)T  and  a.67=(0  1 0)T.  The  magnitude  ||  .C^fl^ 

k 

decreases  rapidly  as  the  hand  moves  outward  from  the  Z 
axis.  This  plot  also  indicates  that  the  maximum  compliance 
magnitude,  C (4>)=  l|cj|  , is  a position  dependent 
function.  In  order  to  enhance  the  overall  stiffness  of  the 
structure  and  to  guarantee  a specified  level  of  precision 
under  a known  magnitude  of  load,  the  smallest  value  of  the 
maximum  compliance  magnitude  is  the  basic  specification  we 
should  consider.  From  the  global  point  of  view,  the  design 
task  can  be  formulated  as: 

Minimize  the  maximum  compliance  magnitude 

function,  C ( d> ) , subject  to  the  joint 

max  — 

angle  constraints 

< h < 1 ' 2 "• 

Where  C (<b)  can  be  evaluated  from  the  local  compliance 
max  — 

criterion  in  Section  5.6.  The  compliance  distribution 
obtained  by  this  criteria  will  be  the  optimal  compliance 
distribution  to  satisfy  the  precision  requirements  in  the 
workspace. 
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Based  on  this  global  optimization  criterion,  the  same 
industrial  robot  is  used  to  investigate  the  optimal  dis- 
tribution actuator  compliance  to  keep  the  end-effector 
deflection  less  than  0.005  inches  for  applied  forces  up  to 
150  lb  in  magnitude.  Figure  6.30  shows  the  worst  config- 
uration of  the  required  joint  stiffness  for  the  example 
robot. 

Table  6.6  Optimal  distribution  of  joint  compliance 
for  hand  deflection  less  than  0.005  in. 
and  applied  loads  150  lb  in  magnitude 


Joint 

1 

2 

3 

4 

5 

6 


Joint  compliance 
1.453x10  ^ rad/in-lb 
1 .453xl0_ 9 
2.07  5xl0-9 
4.842xl0_9 
7 . 263xl0-9 
1 .453xl0'8 


Now  it  becomes  useful  to  applythese  joint  stiffnesses 

inthe  natural  frequency  analysis  of  the  industrial  robot. 

* * 

The  configurations  investigated  consist  of  an  X -Z  plane 

of  the  locations  of  the  hand  reference  point  H with  the 

* 

hand  pointing  outward  from  the  Z axis  in  a single 

T T 

orientation  defined  by  S^=(l  0 0)  and  = 1 0)  * 

Figure  6.31  displays  the  distribution  of  the  fundamental 
natural  frequency  and  that  the  lowest  first  natural 
frequencies  are  along  the  outer  boundary  of  the  workspace 


at  about  64  Hz . 


Joint  angles 
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H 


Figure  6.31  First  natural  frequency  distribution  of  the  industrial  robot 

with  the  joint  stiffnesses  K^=[6.89  6.89  4.82  2.07  1.38  0.69] 
x 10®  in-lb/rad 


CHAPTER  7 


CONCLUSIONS  AND  RECOMMENDATIONS 

t 

7 . 1 Conclusions 

A systematic  and  unified  approach  for  analyzing  and 
distributing  the  actuator  parameters  of  robotic  manipu- 
lators has  been  presented.  The  design  criteria  and  compu- 
tational methods  developed  in  this  work  can  greatly  expand 
the  designer's  understanding  and  reduce  the  design  cycle 
time  for  accurate,  reliable  manipulators.  The  techniques 
developed  in  this  effort  can  also  lead  to  improved  manipu- 
lator control  algori thorns  which  consider  how  the  effective 
stiffness,  strength  and  speed  characteristics  vary  through 
out  the  workspace,  and  make  adjustment  of  the  distribution 
of  system  parameters  to  enhance  controllability,  especially 
when  precision  control  under  external  disturbance  is 
required . 

Since  the  actuator /drive  components  are  the  primary 
source  of  system  flexibility  and  strength  constraints,  the 
rigid-link  manipulator  model  is  employed  in  this  study.  The 
two  principal  objectives  are: 


220 


221 


1.  Develop  computer-assisted  methods  for  character- 
izing the  effective  strength,  stiffness,  natural 
frequency  and  deflection  of  the  overall  system 
as  functions  of  hand  position  and  individual 
properties  . 

2.  Develop  design  criteria  and  computational  methods 
for  optimizing  actuator  strength  and  stiffness 
distributions  in  general  robotic  manipulators  in 
order  to  meet  static  load,  inertia  load  and  pre- 
cision requirements  and  to  allow  faster  operation 
by  increasing  the  frequencies  of  the  fundamental 
vibration  modes. 

In  order  to  provide  enhanced  system  design  and  control 
over  the  design  process,  computer  generated  plots  for 
compactly  displaying  extensive  dynamic  analysis  information 
and  computer  graphics  for  illustrating  robot  motion  have 
been  used  to  help  designers  select  rational  design  specifi- 
cations. These  would  give  the  designer  the  powerful  tools 
to  compute  and  interactively  display  the  effects  of  changes 
in  the  design  parameters  on  these  key  criteria,  and  to 
obtain  a more  balanced  distribution. 

Hopefully,  the  design  and  computational  methodology 
introduced  herein  will  provide  the  impetus  for  future 
efforts  towards  manipulator  design  and  optimization. 
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7 . 2 Recommendations  for  Future  Research 

It  is  believed  that  the  material  in  this  study  repre- 
sents a significant  step  forward  in  the  design  of  robotic 
manipulators.  Yet  it  must  be  recognized  that  all  the 
research  to  date  in  this  area  represents  only  a small  por- 
tion of  what  can  potentially  be  accomplished.  There  are 
several  logical  extensions  of  the  presented  work.  This 
section  should  by  no  means  be  considered  as  a complete 
listing  of  the  unsolved  manipulator  optimization  problems. 
Rather,  it  is  a brief  summary  of  a few  of  the  more  obvious 
problems  which  would  follow  as  an  extension  and  an  improve- 
ment of  this  work. 

As  has  been  previously  mentioned  in  Chapter  1,  there 
is  a large  number  of  system  design  parameters  associated 
with  a general  manipulator.  These  parameters  need  to  be 
determined  in  order  to  meet  given  criteria.  One  of  the 
most  important  and  most  difficult  topics,  which  remains  to 
be  studied,  is  how  to  distribute  the  mass  parameters  in  a 
appropriate  manner,  since  massive  manipulators  and  in- 
creased speeds  of  operation  make  the  inertia  terms  even 
more  important  in  control  and  design  of  modern  manipu- 
lators. Distribution  of  mass  parameters  for  a general  six 
degree  of  freedom  robot  is  exceedingly  difficult;  there  are 
some  sixty  parameters  for  such  a system.  Synthesis  proc- 
esses are  required  to  reduce  the  size  of  mass  parameters 
before  the  optimization  procedures  can  be  implemented.  In 
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general,  the  effective  inertia  loads  acting  at  the  joints 
can  be  minimized  by  an  improved  distribution  of  mass 
parameters.  For  example,  applying  the  cubic  power  law  to 
the  distribution  of  mass  in  a simple  three-link  planar  arm 
increases  the  fundamental  frequency  by  a factor  of  three 
over  the  value  for  an  arm  with  the  same  overall  mass  and 
joint  stiffness  but  a flat  mass  distribution. 

To  date,  very  little  consideration  has  been  given  to 
develop  design  tools  for  the  geometry  of  robotic  manipu- 
lators. There  are  three  parameters  associated  with  the 
position  of  a joint  axis  relative  to  a neighboring  joint 
axis  in  a manipulator.  Therefore,  a general  six  degree  of 
freedom  manipulator  will  contain  18  geometric  design 
parameters  which  control  the  reach,  workspace,  dexterity 
and  obstacle  avoidance  capability.  Consequently,  a major 
optimization  results.  No  one  clearly  understands  how  to 
rationally  select  these  design  parameters  for  better 
kinematic  capacibilities  of  the  system,  but  some  of  the 
general  objectives  for  design  would  be  to  determine  the 
best  set  of  parameters  in  order  to 

1.  enhance  dexterity, 

2.  expand  operating  space, 

3.  reduce  the  possibility  of  unreachable  zones, 

4.  reduce  the  singular  configurations. 
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Most  existing  robotic  manipulators  are  serial  in 
structure.  One  of  the  pressing  problems  facing  the  de- 
signer in  robotics  is  the  high  level  of  deformation  in 
serial  devices.  Parallel  structure  is  generally  stronger 
since  loads  are  distributed  throughout  the  system  subchains 
while  serial  structure  requires  each  link  to  support  all 
loads  from  that  link  out  to  the  free  end  of  the  arm.  The 
Florida  Shoulder,  which  is  a typical  parallel  actuated 
device,  is  illustrated  in  Figure  7.1.  Hybrid  Structures, 
containing  both  parallel  and  serial  components  as  shown  in 
Figure  7.2,  have  a great  promise  for  high  precision  manipu- 
lators. Unfortunately,  these  systems  are  much  more  diffi- 
cult to  model,  design,  and  control.  The  design  criteria 
developed  in  this  work  can  be  extended  to  properly  select 
the  actuator  sizing  and  stiffness  for  these  devices  to  have 
better  dynamic  performance.  Further  information  about 
parallel  and  hybrid  systems  is  given  in  [45,  73  and  79]. 

The  author  realizes  that  many  of  the  problems  that 
have  been  mentioned  here  will  be  extremely  difficult  to 
solve,  and,  of  course,  countless  other  important  problems 
exist  which  have  not  been  discussed  here.  It  is  evident 
that  much  more  research  is  necessary  before  a comprehensive 
and  systematic  design  procedure  is  available  for  such 
devices.  The  author  hopes  this  study  has  made  at  least  a 
small  contribution  toward  the  goal  of  developing  design 
criteria  and  methods  for  robotic  manipulators. 
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Figure  7.1  Three  degree  of  freedom  Florida  Shoulder  module 
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Hand  (end-effector) 


Figure  7.2  A robotic  manipulator  of  hybrid  structure 


APPENDIX  A 


DERIVATION  OF  THE  KUHN-TUCKER  CONDITIONS 


In  attempting  to  develop  algorithms  or  computational 
tools  for  solving  nonlinear  problems,  it  is  useful  to  have 
some  information  concerning  the  characteristics  of  an 
optimal  solution.  In  Chapter  2 a set  of  the  Kuhn-Tucker 
conditions  were  stated  which  an  optimal  solution  must 
satisfy  for  a constrained  optimization  problem.  In  this 
appendix  the  conditions  will  be  derived  in  detail. 

Let  us  consider  the  minimization  of  a general  function 
with  respect  to  an  n-dimens ional  vector  X,  subject  to  m 
inequality  constraints. 

Minimize  f(X)  subject  to 
C (X)  < 0,  j = 1,  2,  . . . , m 

where  X=[Xl,x2, ... ,xn]T.  All  equality  constraints  are 
taken  into  account  implicitly  in  here. 

The  inequality  constraints  can  be  transformed  into 

equality  constraints  by  introducing  nonnegative  slack 

variables,  S.,  defined  such  that 
J 

Cj  (X)  + sj  = 0,  j = 1,  2,  ...,  m ( A • 1 ) 

or 

S = t-cj  (X)  1 1/2  _>  °.  j = 1,  2,  ....  ra  (A. 2) 
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The  problem  is  converted  as  follow: 


Minimize  f(X)  subject  to 

C. (X)  + Sj  = 0,  j = 1,  2,  . . . , m 


The  Lagrange  function  L can  be  constructed  as 


L(X,S,X)  = f(X)  + Z X.[C.(X)  + S?]  (A. 3) 

j-1  3 2 ~ J 

T 

where  S= [ S , , S„ , . . . , S ] is  the  vector  of  slack  variables 
— 12  m 

T 

and  X=[  Xj  , X2  , • • • , X ] is  the  vector  of  Lagrange 
multipliers . 

Now,  a set  of  necessary  conditions  for  existence  of  a 
minimum  to  the  Lagrange  function  is  that 


9 L ( X , S , X ) 


8x  . 
3 


— 0,  i - 1 , 2 , • • • , n 


9L ( X , S , A ) 


9 A . 
3 


— 0,  j—  1,  2,  ...,m 


9L  ( X , S , X ) 


3sj 


— 0,  j— 1,  2,  ...,m 


(A. 4) 


(A. 5) 


(A. 6) 


These  three  equations  can  be  rewritten  as 


9 f ( X ) m 9 C . ( X ) 

+ L A.  — — = 0,  i = 1,  2,  n (A. 7) 

3xi  j=l  J 
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( X)  + sj  = °.  j = 1,  2, 


(A. 8) 


j=  1,  2, 


(A. 9) 


Equation  (A. 8)  ensures  the  constraints  Cj  (JS.)  » j = 1 , 2 


, . • • , m , 


are  satisfied,  while  Equation  (A. 9)  implies  that  either 

X =0  or  S.=0.  If  A.=0,  it  means  that  the  constraint  is 
j J J 

inactive.  Those  constraints  which  are  satisfied  with 


straints  while  those  that  are  satisfied  with  equality  sign, 

C =0,  are  termed  as  active  constraints.  On  the  other  hand, 
3 

if  Sj=0>  ic  means  that  the  constraints  is  active  at  the 
optimum  point . 

Let  the  set  indicate  the  indices  of  those  con- 
straints which  are  active  at  the  optimum  point  and  let  H2 
include  the  indices  of  all  the  inactive  constraints.  Thus 
for  j£H^,  the  constraints  are  active,  and  for  The 

constraints  are  inactive,  and  Equation  (A. 7)  can  be  simpli- 
fied as 


strict  inequality  sign,  C^<0,  are  called  as  inactive  con- 


3f (X) 


9C..  (X) 


+ I X . — ■*- 

3xi  j6H1  3x. 


= 0,  i = 1,  2, 


• • • > 


n (A. 10) 


Similarly,  Equation  (A. 8)  can  be  written  as 


Cj(x)  = 0,  (jeHj) 

C.(X)  + S - 0,  (j6H2) 


(A. 11) 


(A. 12) 
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Equations  (A. 10),  (A. 11)  and  (A. 12)  represent  n+g+(m-g)= 

n+m  equations  in  n+m  unknowns  x^ ( i= 1 , 2 n) , X.  (j6Hj) 

and  Sj  (36H2)  where  g denotes  the  number  of  active 
constraints . 

Equation  (A. 10)  can  also  be  expressed  as 
3f(X)  3C.(X) 

I X , i = 1,  2,  n (A. 13) 

3x±  jSHj.  j 3x. 

These  equations  can  be  written  collectively  as 

- Vf (X)  = Z X.  VC . (X)  (A. 14) 

jeHj.  J 2 

where  Vf(X)  and  VC^.(X)  are  the  gradients  of  the  objective 
function  and  j th  constraint,  respectively.  Thus  the 
negative  of  the  gradient  of  the  objective  function  can  be 
expressed  as  a linear  combination  of  the  gradients  of  the 
active  constraints  at  the  optimum  point. 

Before  showing  that  the  X ' s (j6H^)  have  to  be 
positive  in  the  case  of  a minimization  problem,  let's 
define  the  term  of  feasible  direction  of  a vector.  The 
search  direction  satisfying  that  a small  move  in  that 
direction  from  a point  X violates  no  constraints  is  called 
a feasible  direction.  Thus  for  problems  with  sufficiently 
smooth  constraint  surfaces,  any  vector  jS  satisfying  the 


relation 
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C.(X  + aj; ) = S1.  VC  (X)  < 0 (A.  15) 

da  -1  a=0 

can  be  called  a feasible  direction. 

T 

By  premultiplying  both  sides  of  Equation  (A. 14)  by 
which  is  a feasible  direction,  we  obtain 


-ST . Vf(x)  = Z'  A.  ST . Vc.(X)  (A. 16) 

j6Hx  J J 

Since  S is  a feasible  direction,  it  should  satisfy  the 
relations 


ST.  VC^X)  < 0,  ( j SH  x ) (A. 17) 

Thus  if  Aj  > 0 (jeH^,  the  quantity  S1 . Vf ( X)  can  be  seen  to 

be  positive  always.  Where  Vf(X^)  indicates  the  gradient 
T 

direction  and  S^.Vf(X)  represents  the  component  of  the 

increment  of  f(X)  along  the  direction  If  ^ .Vf(3()>0, 

the  function  value  increases  as  we  move  along  the  direction 

S.  Hence,  if  A^'s  (jeH^  are  positive,  we  will  not  able  to 

find  any  direction  in  the  feasible  domain  along  which  the 

function  value  can  be  further  decreased.  Since  the  point 

at  which  Equation  (A. 17)  is  assumed  to  be  optimum,  A ^ ' s 

( j S H ^ ) have  to  be  positive. 

Thus,  the  conditions  to  be  satisfied  at  a constrained 
£ 

minimum  point,  X , of  the  problem  can  be  expressed  as 
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3f(X)  3C  (x) 

+ £ X. — - = 0,  i = 1,  2,  n (A. 18) 

J6H1  3xi 


and 


Xj  > 0,  ( j 6 Hj)  (A. 19) 

These  are  the  Kuhn-Tucker  conditions.  If  the  set  of 
active  constraints  is  not  know,  the  alternative  form  of  the 
Kuhn-Tucker  conditions  can  obtained  from  Equations  (A. 2), 
(A. 7),  (A. 8)  and  (A. 9)  and  stated  as  follows: 

3f  ( X)  3C . ( X) 

+ £ X.  1 = 0,  i = 1,  2,  n (A. 20) 

3x±  j = l J 9x± 

Cj (X)  < 0,  j - 1,  2,  ....  m (A. 21) 

Xj  Cj  (X ) = 0,  j = 1,  2,  ....  m (A. 22) 

and 

Xj>°,  j = 1 , 2 , . . . , m (A. 23) 

These  conditions  are,  in  general,  not  sufficient  to  ensure 

a relative  minimum.  However,  the  Kuhn-Tucker  conditions 
are  the  necessary  and  sufficient  for  a global  minimum  of 


convex  programming  problems 


APPENDIX  B 


REVERSE  DISPLACEMENT  ANALYSIS 
°F 

CINCINNATI -MIL AC RON  T -776  ROBOT 


B.l  Introduction 


A major  problem  in  the  operation  of  a manipulator 
controlled  by  a computer  which  is  directing  the  end- 
effector  to  move  from  one  position  to  another  has  been  to 
obtain  a set  of  joiirt  displacments  which  will  position  the 
end-effector  at  a given  point  with  a specified  orientation 
within  the  workspace.  A general  theory  [72,  76,  81]  for 
the  algebraic  analysis  of  spatial  mechanism  geometry  which 
has  been  developed  by  J.  Duffy  to  solve  this  problem.  This 
can  be  accomplished  by  joining  the  hand  to  the  first  or 
grounded  joint  by  a hypothetical  link.  In  this  way  the 
problem  reduces  to  the  analysis  of  a corresponding  closed 
spatial  mechanism  with  mobility  one.  In  order  to  solve  for 
joint  displacements  in  this  fashion  it  is  necessary  to 
derive  a polynomial  equation  in  the  first  joint  displace- 
ment. The  degree  of  the  polynomial  is  the  number  of  maxi- 
mum real  modes  for  an  arbitrary  hand  location  and  orien- 
tation within  the  workspace.  The  central  problem  becomes 
the  derivation  of  this  polynomial  which  is  the  so-called 
input-output  equation  of  a corresponding  closed-loop 
spatial  mechanism.  Once  this  polynomial  is  known  it  is  a 
relatively  simple  task  to  develop  an  algorithm  for  comput- 
ing the  remaining  joint  displacements.  It  is  thus  possible 
to  compute  joint  displacements  for  large  finite  hand 
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displacements,  and  it  is  relatively  simple  to  derive  an 
algorithm  to  guide  the  hand  along  some  path  between 
positions . 

The  purpose  of  this  appendix  is  to  derive  a detailed 
position  analysis  procedure  for  the  Cincinnati-Milacron 
electric  T^-776  robot  as  shown  in  Figure  4.1.  The  kine- 
matic representation  of  the  industrial  robot  is  displayed 
in  Figure  4.2  and  the  corresponding  kinematic  parameters 
are  listed  in  Table  4.1.  There  are  two  parts  in  the  re- 
verse solution  procedure  to  generate  the  joint  displace- 
ments for  the  specified  hand  location  and  orientation  of 
the  example  manipulator.  First,  a hypothetical  link  is 
used  to  form  a closed— loop  mechanism  of  the  open  manipu- 
lator chain  in  order  to  find  0y  , a71,  a71»  (01-())1)»  s77> 

S*  Once  the  loop  has  been  closed,  the  remaining  joint 

displacements  can  be  determined. 

B . 2 Reverse  Displacement  Analysis  - Part  I 

The  manipulator  hand  is  considered  to  be  a rigid  body 

which  moves  in  three-dimensional  space.  Its  position  can 

^ & 

be  specified  by  three  coordinates  P^(XH,  Y^,  Zfl) , and  by 
the  direction  cosines  £g7(X67»  Y^y,  Z ^y)  , S_y(x7»  Yy  , Zy)  of 
the  hand  and  gripper  axes.  It  is  assumed  in  the  following 
analysis  that  these  nine  quantities  are  specified  and  that 
it  is  required  to  compute  the  corresponding  joint  displace- 
Clearly , it  requires  only  six  independent 


ments . 
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parameters  to  locate  a rigid  body  in  three-dimensional 
space  and  the  above  parameters  are  therefore  over-abundant 
by  three.  This  is  accounted  for  since 


£67  • £67  1 


(B.l) 

(B.2) 

(B.3) 


Figure  B.l  illustrates  the  hand  joined  to  the  first  joint 
in  the  chain  by  a hypothetical  link  a-ji  and  offset  and 

S ^ thus  forming  a closed  spatial  mechanism. 

It  is  now  necessary  to  determine  the  six  constraint 

parameters  S 77,  a7i’  ®7’  a71*  ^11  anc*  ®1-  ^1* 

* * * * * * . . * „* 
transformation,  [ ( XR , Y^,  Z^)  , (X67’  X67*  ^67^’  o* 

Z*)]Z>[S77,  a71,  07,O71,  S*L,  ei-  (j)^,  is  derived  in  the 
following  steps: 


Step  1.  Calculate  the  value  of  C71 
C 7 1 = —7  * -1 

If  C71=+l,  go  to  Step  2.  Otherwise,  go  to 
Step  6 . 

Step  2.  C71=j-1  and  therefore  S7^  = 0.  This  is 

because  the  vectors  S^  and  S_-^  are  either 

parallel  or  anti-parallel.  Let  S77=0. 

Step  3.  From  the  vector  loop  equation  (see  Figure  B.l) 

* 

V 4-  a7^  £71  ^ii  S1  = 0 

A 

the  hypothetical  link  length  a71  and  S^  can 
be  expressed  as 
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Figure  B.l  Completion  of  the  spatial  loop 
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Step  4 . 

Step  5 . 
Step  6 . 

Step  7 . 


* 


S11  = 

-S^l  . V 
1 * l 

a 7 1 = 

|v  + Su  Sjl 

if  a71^o, 

compute  ay  ^ 

—11  ~ -§.1^/  a7 1 

and  go  to  Step  8. 

If  a^  = 0,  let  a-j  ^=£57  and  ®7  = 0 and  go  to  Step  9. 
Find  the  unit  vector  a_y  ^ and  the  length  Sy^ 

£71  = (JL7  x Sj)  / |S7  x SJ 


S 7 1 “ -71  * (-7  x -1^ 

From  the  vector  loop  equation 

1 + a71  ±71  + S11  -1  = ° 
the  hypothetical  link  length  ay^ 

tical  offset  length  Sy^  and  S ^ 

expressed  as 


, hypothe- 
can  be 


S77  - (V  . a-j  ^ x _Sj)/ 

a71  " (S7  . V x Sj)/  S?1 

S1 1 = (I7  • £71  x D / s 7 1 
Step  8 . Find  0 y 

c7  = £67  • -71 

s7  = 17  * -67  x -7 1 
Step  9.  Compute  (0^-  <J>  ^ ) 

Cos ( 0 ^ ^ ) ^71  * — 

Sin(  0 ^ = S^  . a-jy  x i 
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B . 3 Reverse  Displacement  Analysis  - Part  II 


Taking  the  information  obtained  from  the  first  part  of 

the  reverse  displacement  analysis,  it  is  possible  to  find 

the  following  joint  displacements,  0^,  Q^y  ®3>  ®4’®5’  and 

0 . Write  the  vector  loop  equation  for  the  closed-loop 

6 

mechanism 


0 


S11  -1  + a23  -23  + S44  -44  + S66  -6  + 
S 7 7 —7  + a7 1 -71 


(B.4) 


With  this  equation  and  information  obtained  in  Part-I,  we 
proceed  to  the  calculation  of  9^.  The  steps  for  obtaining 
all  joint  displacements  are  shown  in  Figure  B.2. 

Taking  dot  product  of  the  vector  loop  equation, 
Equation  (B.4),  with 


0 


(S*11  — 1 + a23  —2 3 + S 4 4 —4  + S66  + 

s77  I7  + a7 1 —7 1 ^ ’ —2 


(B.5) 


Due  to  the  actual  physical  arrangement  of  the  example  robot 
the  following  is  true, 


(B.6) 
( B . 7 ) 


then.  Equation  (B.5)  becomes 
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Figure  B.2  Steps  for  obtaining  all  joint  displacements 
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66 

—6  ' -2  + 

S 7 7 —7  * 12  + a7 1 -7 1 * -2 

66 

Z 7 1 + S 7 7 

Z 1 + a 7 1 U 12 

(B.8) 

where 


Z 7 1 = S 7 S1  C 7 1 C 7 C1 
Z1  = _S  7 1 C1 


U 


12 


S 


1 


(B.9) 
(B.  10) 
(B.  11) 


Substituting  the  Equations  (B.9),  (B.10)  and  (B.ll)  into 

Equation  (B.8),  then  Equation  (B.8)  becomes  an  input-output 
equation  which  0^  is  a function  of  0y 


0 = S1(S66  S 7 + a71)  + C1(_S66  C 7 C71  S77  S71} 

= S1B7  + C1A7  ( B • 12) 


where 


A7  " S 6 6 C7  C 7 1 S77  S71 


B 7 = S 6 6 S 7 + a7 1 


(B.  13) 
(B. 14) 


0j^  and  <t>  ^ can  be  obtained  as 

(B.  15) 
(B . 16) 


6 = Tan  1(Sl/Cl)  = T an" 1 ( -A? / B ? ) 

4»  = 9j  - (61  - <pl),  (-135°  <(}>!<  135°> 
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The  vector  from  the  second  joint  to  the  wrist  can  be 
defined  as 


1 ~ (S66  —6  + S 7 7 —7  + a 7 1 -7  1 + S11  -1 ) 


(B.  17) 


Since  V,  a 23  and  S^. form  a triangle  and  the  lengths  of 
these  three  sides  are  known,  can  be  solved  by  using  law 

of  cosines : 


S3  ' 'll'2  - a23  - S44>'2a23  S44  <B'18) 

c3  = ±( 1 “ S3)  1/2  (B  . 19) 


then,  angle  9^ 


03  = Tan  1(S3/C3),  (-45°  < 63  < 60°) 


(B  .20) 


The  second  joint  angle  is  determined  by  a pair  of 
equations  representing  the  projection  of  the  vector  _V  in 


directions  of 

a 1 2 and  d ^ 2 = 

=— 2 

x a | 2 1 

1 

( a 2 3 

+ s44  s 

3)  C2  + (S44 

C 3 ) 

S 2 = 

V . 

’ ±12 

(s44 

c3)  c2 

- ( a 2 3 + S 4 4 

S3) 

S 2 = 

V . 

■ ii2 

( B . 2 1 ) 

(B . 22) 


Solving  for  S2  and  C 2 yields. 
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(V  ^ ^44  ^ 3 ^ '—12^  ^ a2 3 ^44  ^3) 


44  J3 


( B . 2 3 ) 


+ S ,.  , + 2 a 


23  T 4 4 


23  s44  a3 


(V  « a ^ 2 ) ( ^2  3 


S44  s3)+(v  . d12)(s44  C3) 


(B . 24) 


a2 3 + S44  + 2 a 2 3 S44  S3 


then,  angle  02 

0 2 = Tan_1(S2/C2) , (30°  < ©2  < 117°)  (B.25) 

Joint  angle  0^  is  determined  from  a spherical  cosine 
law  in  [76] 


Z 5 _ Z 3 2 1 7 


(B  .26) 


and 


Z 5 ' C 5 6 C 4 5 S56  S45  C5 


( B . 2 7 ) 


where  ^2,217  Can  0^ta^ne^  from  Table  B.l.  From  Equations 
(B.26)  and  (B.27),  C,.  can  be  solved  as 


C 5 " (C56  C 4 5 Z3217)/S56  S45 


( B . 2 8 ) 


and  therefore, 


s 5 = +(1 


c2)‘/2 


(B  . 29) 
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Joint  angle  0^  is  determined  from  a pair  of  spherical 
sine  and  sine-cosine  laws  in  [76], 


G 5 4 “ X 3 2 1 7 
W54  = Y3217 


(B  . 30) 
( B . 3 1 ) 


Using  the  expressions  for  G , W54>  X3217  and  Y 3 2 1 7 in 
Table  B.l  yields, 


(S56  C 5 C 4 5 + C 5 6 S45)S4  + (S56  S5)C4 
= X 3 2 1 7 

(S56  C 4 5 C 5 + C 5 6 S45)C4  + (_S56  S5)S4 
= v 

3217 


( B . 3 2 ) 


(B.33) 


then,  using  Cramer's  rule 


S 


4 


X 3 2 1 7 S56  S 5 

Y 3 2 1 7 S 5 6 C 4 5 C5  + C56  S45 
A 


( B . 3 4 ) 


C 


4 


S 5 6 C45  C 5 + C 5 6 S45  X3 2 1 7 

~S 5 6 S 5 Y 3 2 1 7 

A 


( B . 3 5 ) 


Where  A is  the  determinant  of  the  coefficients  of  Equations 
( B . 3 2 ) and  (B.33)  as 
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A = (S56  C4 5 C 5 + C 5 6 S45)2  + (S56  S5)2  (B‘36) 

The  remaining  joint  angle  06  is  determined  from  a pair 
of  spherical  sine  and  sine-cosine  laws  in  [76], 


G 6 ~ X5 4 3 2 1 
\ = Y5432 1 


( B . 3 7 ) 
( B . 3 8 ) 


Using  the  s implications  in  Table  B.l  yields  the  explicit 
solution, 


S 6 " X5 4 3 2 1 
C 6 = Y54321 


( B . 39  ) 
( B . 4 0 ) 


then,  the  joint  angle  0& 


86  - T.n'hSj/Cj)  (B-4 

3 

The  reverse  displacement  analysis  for  T -776  robot 
has  been  accomplished  by  solving  for  the  six  joint  angles 
of  the  corresponding  heptagon  spatial  mechanism. 
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Table  B.l  Definition  of  direction  cosine  notation  and 
s impl if i cat i o ns 


X 3 2 1 7 

- C2+3 

X17 

" S 2+3  Y 

17 

Y 3 2 1 7 

= c34(s 

2+3 

X 1 7 

+ C 2 + 3 

Y 1 7 

) - s 

34 

Z 1 7 " ~Z  1 7 

Z 3 2 1 7 

= S 3 4 ( S 2+3 

X 1 7 

+ C2+3 

Y17 

) + c 

34 

Z 1 7 

“ S 2 + 3 

X17 

+ C 2+3  Y 

17 

X17  = 

C1  X7  ‘ 

’ S1 

Y 7 

Y 1 7 " 

C12(S1 

X7  ' 

- C1 

V 

- 

S 1 2 

X7  = 

-Z- 

7 

II 

r^- 

H 

S12(S1 

X7  ' 

* C1 

V 

+ 

C 1 2 

X7  = 

S1 

X7  + Cj  y7 

11 

IX! 

S 67  S 7 = 

" S7 

Y7  " 

-<S71  Ci 

67  + 

C71 

S 6 7 

C 7 

) = 

-C  7 1 

C 7 

Z7  = 

C 7 1 C 6 7 

- S 

71  S 

67  C1 

J = 

-S  7 1 C 7 

G 5 4 = 

S56(S5 

E4 

+ C 5 

V 

C 5 6 

G4 

E 4 = C4 
E4  = C 4 5 S 4 
G4  = s45  s4 


W 


= S^(S,  U,  + c,  V.)  - 


56  “ 5 6 v “ 5 " 4 ' ”5 


C56  W4 


U4  = “S4 
^4  = C4 5 C 4 


W4  - s 4 5 
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Table  1 

X54  3 2 1 

Y 5 4 3 2 1 

X 4 3 2 1 

Y 

432  1 
Z 4 3 2 1 

X321  = 

Y 3 2 1 

Z 3 2 1 = 


. 1 , Continued 


" C 5 X 4 3 2 1 " S 5 Y432  1 

= c56(s5  x4321  + c5  y4321)  - s56  z4321 
= c4  x321  - s4  y321 


C45<S4 

X3  2 1 + 

C4  1 

:32p 

- S45 

Z 3 2 1 

s45(s4 

X32i  + 

C4  1 

:321) 

+ c45 

Z 3 2 1 

C 2+3  X1 

S2  + 3 

Y1 

C34( S2  + 3 

Xi  + 

C 2 + 3 

V 

- s34 

X1  = 

S 3 4 ^ S 2 + 3 

Xi  + 

C 2 + 3 

V 

+ c34 

Z1 

S 2 + 3 X1 

+ C2+3 

Y1 

12  S1  = S1 

( S 7 1 C 1 2 + C 7 1 S 1 2 Cl}  = _C  7 1 C1 
71  C 1 2 “ S 7 1 S 1 2 C1  = _S7  1 C 1 

67  S 6 = S 6 
67  C 6 = C 6 
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